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ABSTRACT 



In order to continue to improve the usefulness of robots, it is becoming increasingly 
important to have them act as autonomous agents. A significant step toward this object is 
autonomous motion planning. This research was conducted as part of a broader effort to 
empower Yamabico-1 1, a mobile robot under development at the Naval Postgraduate 
School, with ability to move autonomously. We believe that this problem is best attacked 
in layers. 

This thesis is our proposal for the initial layer. Given a robot’s current location and 
its goal location, we use the homotopy relation to reduce the infinite set of path choices into 
a more manageable and smaller set of path classes. Specifically, we solve the problem of 
how to enable a robot to autonomously identify and label these classes of paths. 

We begin by decomposing the robot’s operating environment into a collection of 
convex pieces called cells. The cells are transformed into a graph by adjacency. We show 
that every simple path on the graph corresponds to a unique simple homotopy class in the 
robot’s world. We then search the graph to give each class a symbolic representation which 
also provides intermediate path planning clues. Subsequent layers can use these clues to 
form a more detailed plan. 

We implement the cell decomposition, graph transformation, and path class 
labeling as C programs, and preprocess them on a Unix workstation. The resulting data 
structures are then compiled and linked into the robot’s kernel. All implementation has 
been integrated into the model-based mobile robot language (mml) used by Yamabico-1 1. 
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I. INTRODUCTION 



In order to improve the usefulness of robots, it becomes increasingly important to 
have them act as autonomous agents. A significant subproblem of this objective is motion 
planning. Autonomous motion planning is a broad area including a diverse set of topics. 
Among these is the problem of enabling a mobile vehicle to relocate itself from one 
configuration to another while avoiding obstacles along its path. 

This research was conducted as part of a broader effort to empower Yamabico-1 1, 
a mobile robot under development by students and faculty of the Naval Postgraduate 
School, with the ability to move autonomously. We propose to simplify this difficult 
problem by attacking it in layers. The highest and most abstract layer partitions the set of 
paths into equivalence classes. A specific class is then selected and used by lower layers 
where the detailed motion plan is formed. The lowest and final layer interprets the detailed 
motion plan into specific control instructions for the mobile robot, where movement is 
realized. 

A. PROBLEM STATEMENT 

Given an initial and goal configuration for a mobile robot, we want to partition the 
infinite set of path choices into a more manageable and general set of path classes. Each 
class must be uniquely and unambiguously identified in a manner consistent with its 
topology. Additionally, the class names must provide useful motion planning information 
for lower levels. Finally, the model used to represent the robot’s world and the set of path 
classes must be integrated into the global motion planner and the model-based mobile robot 
language used by Yamabico. 

B. ASSUMPTIONS 

The first assumption is that the robot will be working in a familiar environment with 
complete knowledge of the topology. It will not, however, use external references to guide 
its motion, such as following marked or predescribed paths. We also assume that the robot 
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has perfect knowledge of its configuration (location and orientation). This is accomplished 
through odometry control, and if necessary, self-correction using internal sensors. 

All work will be done in two dimensions. We do not assume that the robot or its 
operating environment are restricted to two dimensions, but we do assume that the problem 
can be solved by considering the projection of the robot and its environment onto the 
XY-plane. 

The last assumption is that some of the work can be preprocessed. The 
preprocessing includes representing the operating environment, representing the path 
classes, and building the model used by the upper layers of the motion planning process. 
This preprocessing frees the robot to perform the real-time calculations necessary to realize 
motion and operate its internal sensors. 

C. APPROACH 

We begin by decomposing the world into a collection of path-connected convex 
cells whose union is exactly the robot’s free space. Information about the connectivity of 
the cells is transformed into a graph which is searched to find path classes. The global 
motion planner selects a class, and then uses the graph to determine the sequence of cells 
through which the robot must move. This approach simplifies the task of motion planning 
in two areas. First, by attacking the problem in layers, we decrease the number of choices 
that must be considered by the global motion planner. Second, since the robot will move 
from convex cell to convex cell, the computation required for intracell motion planning 
should be reduced. This frees the processor for lower level tasks. 

D. YAMABICO-11 

Although the theory and essence of this work applies to autonomous motion 
planning for any mobile robot, it will first be implemented on Yamabico-1 1. Yamabico-1 1 
has a single axis with two fixed wheels which are independently driven by separate motors. 
Additionally, it has four shock absorbing, free-moving, caster wheels for stability. Control 
of the robot is accomplished by a single SPARC processor with 16 Mbytes of main 
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memory. Twelve 40 KHz ultrasonic senors are used by the robot to verify odometry and 
avoid unexpected obstacles. 

Yamabico is currently located in the Computer Science Robotics Laboratory on the 
fifth floor of Spanagel Hall at the Naval Postgraduate School. Spanagel Hall is a typical 
academic building. The fifth floor consists of a long hallway with classrooms and offices 
to either side, and a large computer lab at the east end. Most of the testing is conducted in 
the hallway and foyer immediately outside of the lab. The hallway has no indigenous 
obstacles, so wooden boxes are temporarily placed wherever an obstacle is desired. 

All implementation programs are written in ANSI C and compiled using the GNU 
Project C Compiler. User access to implementation programs is provided through the 
model-based mobile robot language (mml), a high level language developed by students at 
the Naval Postgraduate School. Specific details of the hardware and software systems of 
Yamabico can be found in [Yama93] and [Yama94], 

E. THESIS ORGANIZATION 

The next chapter provides formal definitions used throughout the thesis. It 
introduces the reader to some of the basic elements of topology, and describes the primary 
tool we will use in the initial path planning layer. Chapter III is a discussion of two 
properties of a robot’s operating environment that have served as the basis for previous 
motion planning methods. The chapter includes an introduction to the common data 
structures and recent research of both properties. Although these properties are not strictly 
related, we combine their discussion in this chapter to separate them from our proposal. 
Chapter FV is a detailed presentation of our proposed method. Here we present the 
underlying idea and provide examples of how we use the connectivity of the robot’s world 
to reduce the path planning problem. We also talk about a potential weakness in our plan 
and offer two solutions. In Chapter V we describe the implementation of this method on 
Yamabico- 1 1, to include the geometric model, data structures and algorithms. We end the 
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thesis by analyzing the method we have chosen, and by mentioning additional and 
supplementary topics of research. 
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n. TOPOLOGY 



Before we discuss the issue of motion planning, we need to give some precise 
meaning to the concepts that provide the basis for our proposal. In accordance with the 
previously stated assumptions, we will restrict the discussion in this chapter to the 
Euclidean plane. Additionally, we consider a robot to be a point unless explicitly stated 
otherwise. This chapter is not a complete lesson in topology, but rather a formal 
introduction of those definitions needed later. The reader familiar with this area can skip 
the chapter without loss of continuity. 

A. TOPOLOGICAL SPACE 

1. Definitions 

From (Cr78] we take the standard definition of a topology for a set X as a family T 
of subsets of X satisfying the following properties: 

1 . The set X and the empty set 0 are in 7. 

2. The union of any family of members of 7 is in 7 

3. The intersection of any finite family of members of 7 is in 7 

A topological space is a pair {X,T) where X is a set and 7 is a topology for X. If there 
is no ambiguity, the topological space can be referred to simply as X. A space X is 
connected if it is not the union of two disjoint, nonempty open sets. Intuitively, this means 
that X can best be viewed as “one piece”, and is in some sense indecomposable. A related 
idea, and one which is more suitable to our purposes is that of path connectedness 
[GaGr83]. 

Let X be a topological space, and let xq and x; e X. A path n in X from xqXoxj is 
a continuous function /:[0,1] — > X such thaty^O) = xq andy(l) = x;. We say that X is path 
connected if for every pair of points xq and x; in X, there exists a path between them. 
Additionally, If a space is path connected, then it is also connected [GaGr83]. 
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Two characterizations of sets which are needed for later definitions are whether a 
set is open or closed, and whether a set is bounded or unbounded. A set is closed if and only 
if it contains its boundary. Additionally, the complement of a closed set is open which 
implies that a set is open if and only if it contains none of its boundary. Since a set may 
contain only a portion of its boundary, it may be neither open nor closed. We give the 
definition of a bounded set by using the intuitive notion of distance. A set is bounded if the 
distance between any two of its members is finite. A set that is not bounded is said to be 
unbounded. [Ki89] 

Finally, we introduce the concept of a hole. The Jordan Curve Theorem states that 
a simple closed curve C in the Euclidean plane separates the plane into two open connected 
sets with C as their common boundary. Exactly one of these sets is bounded. [Cr78] We 
define a hole to be one of the open connected sets. We say that the hole is normal if it is 
bounded, and inverted if it is unbounded. Sometimes it may be useful to consider the hole 
along with its boundary, but generally we refer to them separately. 

2. The Robot’s Space 

For this research, we consider the robot’s space to be the Euclidean plane with 
holes. We allow an unlimited, but finite, number of normal holes, which are obstacles for 
the robot. We also allow one inverted hole, which if present, defines the robot’s outer 
limits. We assume that the boundary of all holes are simple polygons. Furthermore, we 
consider the boundary of a hole to be directed curve which when traversed, puts the hole to 
the left. This directed boundary naturally defines the neighbors of a vertex to be the next 
vertex, and the previous vertex. The free space, or the robot’s operating space, is the 
complement of the union of all the holes. We call the free space, together with the set of 
holes, the robot’s world. 

We also consider paths to be directed curves with natural direction fromy(0) tof[l). 
We say that/(0) and/(l) are the endpoints, and that the path joins them. We refer lofiO) as 
the start or initial position, andy( 1 ) as the goal. Figure 1 , on page 7, is an example of a world 
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with two normal holes /i; and /12; one inverted hole hf, and three paths K\, K2, and 7C3 from 
S to G. 




Figure 1 : Topological Space with 3 holes and 3 paths 



B. HOMOTOPY 

It should be clear that, in any connected space, the set of paths between any two 
points is infinite. In order to simplify the problem of choosing a path we want to group paths 
that are, in some sense, alike. Before we give a formal definition, we present an intuitive 
idea of what makes two paths similar. In Figure 1 , we see that paths Ttj and K2 are somewhat 
similar in that they both go to the right of /12 and to the left of h^. Another observation is 
that there is no hole “between” them. Notice, however, that /12 is between paths 7 t| and 7C3. 
Based on these observations we might conclude that tCi and K2 should be grouped together, 
and 713 should be in a group by itself. The relation of homotopy provides a formal method 
for making these groupings. 
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Consider two paths in the robot’s world,/:[0,l] and g:[0,l], with common 
endpoints. We say that/is homotopic to g, written/=g, provided there is a continuous 
function //:[0,l]x[0,l]— which satisfies these equations: 



In other words, // is a function that allows us to continuously deform one path into the other 
without crossing an obstacle. Furthermore, homotopy defines an equivalence relation on 
the set of paths which partitions them into a collection of homotopy classes. [Cr78] We will 
use this relation to reduce the problem of path selection by considering a finite set of 
homotopy classes rather than an infinite set of paths. 



Hm =/tt)Vt€[0,l] 
//(U) = g(t)Vr€[0,l] 

H(U) =yU) = g(l) 



(Eq2.1) 
(Eq 2.2) 
(Eq2.3) 
(Eq2.4) 
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m. PROXIMITY AND VISIBILITY 



Two fundamental properties of the robot’s operating environment are proximity 
and visibility. Each has been used as a basis for previous path planning methods. In this 
chapter we will introduce and discuss the common data structures used to capture these 
properties, and we will briefly present some of the algorithms used to build and employ 
them. 



A. PROXIMITY 

Proximity tells us the obstacle, or portion of an obstacle, to which the robot is 
closest. This is important locally when trying to avoid obstacles since the closest one 
presents the most immediate danger. However, proximity information is more commonly 
used globally when planning for obstacle-avoiding paths. In this section we will focus on 
the global aspects of proximity and how they can be used for autonomous path planning. 

1. Voronoi Diagrams 

The Voronoi diagram was first used in 1975 by Shamos and Hoey [ShHo75] as a 
means of representing proximity for a finite set of points in the Euclidean Plane. It has since 
become the elementary data structure for representing proximity, and continues to have 
broad application in the field of computational geometry. Generally, the Voronoi diagram 
VD{0) of a set O ofn objects in a space W is a subdivision of this space into maximal 
regions so that all points within a given region have the same nearest neighbor in O with 
regard to a general distance measure d [PrSh85]. The Voronoi Diagram is divided into two 
parts: Voronoi boundaries 8 ( 0 ,, Oj) between two objects o, and Oj, and Voronoi regions V{Oj) 
of an object oj. They are described by the following equations: 

B(o^,Oj) = {p€ W\\d(p,o^) = d(p,Oj)} (Eq3.1) 

y(Oj) = {pe Wll V/.yV /; d(p,o.) <d(p,Oj)} (Eq3.2) 
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The first Voronoi diagram, often called the Euclidean Voronoi diagram (EVD), was 

defined over a set of points 0={pj p„), using the Euclidean distance function in In 

this case, the Voronoi Boundary B(pj,pj) is the perpendicular bisector of p,- and pj. When 
only two sites are considered, B{pi,pj) separates the plane into three regions: all points 
which are closer to p, than to pj, all points which are closer to pj than to p,-, and the boundary 
itself If we denote the half-plane which contains the set of all points closer to p^ than to pj 
as H(pi,pj), then the Voronoi Region V(p,) is the polygon formed by the intersection of the 
n-1 half-planes H(pj,pi^), for all pj^ e 0\ p,. The EVD is the union of V(p,) for all p, e O. 

Let us now consider the construction of the EVD. From its definition we 
immediately see that one approach would be to build each polygon individually. In this 

case, we can form the intersection of the n - 1 half-planes in time 0(N ), which suggests that 

the EVD can be constructed in time O(N^). However, the construction of the polygons can 
be improved to O(NlogN) by using a simple divide-and-conquer approach, lowering the 

bound of constructing the EVD to O(N^logN). In fact, the entire EVD can be attacked by 
a divide-and-conquer strategy which yields an optimal 0(NlogN) algorithm presented by 
Preparata and Shamos [PrSh85]. The idea behind this algorithm is to divide the set of 
obstacles into roughly equal parts by median x-coordinate, construct the Voronoi Diagram 
for both parts recursively, and then merge the two pieces to form the complete Voronoi 
Diagram. The bound relies on the fact that the division and merge steps each take 0(N). 
We refer the reader to [PrSh85] for the details of the algorithm and a proof of its 
correctness. 

We now briefly mention two important properties of the EVD, but again refer the 
reader to [PrSh85] or any other text on computational geometry for a complete catalog and 
discussion. First, an embedding of the EVD yields a planar straight-line graph. This allows 
for 0(N) storage of the complete proximity information. Second, the straight-line dual of 
the EVD is a triangulation of O. This dual, called the Delaunay triangulation, is obtained 
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by adding a line between two points if their Voronoi regions share an edge. This fact not 
only implies that the Voronoi diagram can be used to solve other problems in the field, but 
it is also used in some alternative construction algorithms. 

By examining the definition of the Voronoi diagram, we see that the EVD can be 
generalized in three areas: the space W, the objects O, and the distance measure d. A fourth, 
but less common, generalization is to consider the set of points that are closer to any 
k-subset of O.Voronoi diagrams used for motion planning are often generalized with 
respect to O, since the obstacles in a robot’s world are rarely points. However, Voronoi 
diagrams defined for higher dimension or abstract distance functions have also been used. 

An interesting generalization under our assumptions is constructed in using Euclidean 
distance, with O being the set of edges and vertices of the polygonal obstacles. In this case, 
the shape of the Voronoi boundary between two elements of O depends on the type of 
objects considered. Let e, and €j be edges, and let v/ and be vertices of O. As in the EVD, 
B(v/,v^) is the perpendicular bisector of v/ and v^, and B{ei,ej) is the bisector(s) of e, and ej. 
However, B(e,-,v/) or B{vi,ei) is the parabola defined by the focus V/ and the directrix e,. The 
Voronoi region V(e,) or V(v/) remains the intersection of the n-\ half-planes defined by the 
Voronoi boundaries of e,- or v/. More importantly, the Voronoi region of an obstacle is the 
union of the Voronoi regions of its edges and vertices. The construction of this generalized 
Voronoi diagram is not as straight-forward as the EVD, but is still optimally computed in 
time 0(NlogN). In the next section we present an alternative construction algorithm for the 
generalized Voronoi diagram, and another generalization of the EVD with application to 
robot motion planning. 

2. Recent work 

Although the divide and conquer algorithm is well-suited for constructing the EVD 
and some basic generalized Voronoi diagrams, it may not be practical in all cases. Here we 
examine a technique for constructing the Voronoi diagram by a randomized incremental 
addition of the obstacles. First, we take the generalized definition of a Voronoi Diagram 
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from [KJ89]. For a set of obstacles 0={oi,...,o„}, define = J(Oj,Of) to be a bisecting 

curve separating sites o,- and Oj. Let D{oi,Oj) and D{oj,o^ be the two domains separated by 
J(oj,Oj) such that any point in D(Oi,Oj) is closer to o, than to oy Additionally, we must choose 
exactly one of D{oi,oj) or D{Oj,o^ to include 7(o,,Oy). In the case of the EVD, J{pi,Oj) = 
B(pi,pj) and D{Oi,op = H(pi,pj). The Voronoi region of with respect to O, VT?(<7,,0), is the 
intersection of the D^oiyOp), for all € O\o,-, and the Voronoi diagram of O, V(0), is the 
union of the boundaries of the VR{Oi,0), for all o, € O. This definition appears very similar 
to that of the EVD, but, note that we have made no reference to the definition of distance 
or the type of obstacles in O. 

Mehlhom, Meiser, and O’Dunlaing [MM091], propose to build V{0) 
incrementally. Let /? c O be the set of sites already added to V{0). They maintain two data 
structures: The Voronoi diagram V(/?) stored as a planar graph, and the conflict graph G{R). 
The conflict graph consists of vertices which are the edges of V(^) and the obstacles in 0-R. 
There is an edge (conflict) in G{R) between vertices corresponding to an edge e of V{R) and 
an obstacle o, € 0-R if and only if e has a nonempty intersection with VR(OjJi u op. Now 
for each obstacle added to R, they show that only those edges in conflict with o,- need to 
be changed when updating the V(R). The complexity of updating V(R) and G(R) combine 
to produce an algorithm which runs in time O(NlogN). 

To complete this section we want to mention an interesting generalization of the 
EVD with application to robot motion planning. Chew and Kedem’s [ChKe90] approach 
to safe motion planning is based on the intuitive idea that motion along the Voronoi 
boundaries provides maximal clearance. They construct a Voronoi diagram considering 

polygonal obstacles in but use a convex distance function defined by the geometrical 
shape of the polygonal robot. Since the shape of the robot is not a Euclidean circle, the 
distance between two points changes as the robot rotates. They track the effect of these 
changes by plotting the Voronoi diagrams in (x,y,6) space. They show that building the 
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initial diagram takes O(KNlogKN), where K is the number of sides of the robot. Updating 
the Voronoi diagrams in three-space, however, raises the complexity to CXK'^NlogN). 

B. VISIBILITY 

Consider the robot’s world W, and the associated free space F. We say that two 
points, X and y, are visible if they can be connected by a line segment xy such that xy <^F. 
In other words, xy cannot intersect any of the holes in W except possibly at a boundary. If 
X and y are visible, we also say that one sees the other.Visibility is important to motion 
planing for two reasons. First, if the robot can see its goal then, intuitively, the problem of 
motion planning may be simplified. Second, the shortest path between a robot and its goal 
can be found by examining the visibility relationship between the robot, the goal, and the 
vertices of the polygonal holes. In this section we will examine a common data structure 
used to represent visibility and its application to motion planning. 

1. Visibility Graphs 

The visibility graph of a polygon is a graph on its vertices such that two vertices are 
joined by an edge if and only if they are visible. An upper bound for the number of edges 
in the visibility graph occurs when the polygon is convex. In this case, the graph will have 

j edges since every vertex in the polygon can see every other vertex. An immediate lower 

bound for n is obtained by observing that the edges of the original polygon are also edges 
in the visibility graph. O’Rourke [OR87], however, shows that a true lower bound is 2n-3, 
as any polygon will have at least 3 convex vertices. 

As a motion planning tool, we can extend the concept of the visibility graph to the 
case of a polygon with holes. As before, the vertices of the graph are those of the polygons, 
and the graph edges represent the pairs of vertices that are mutually visible. In this case, 
however, we should include the initial and goal position of the robot as vertices in the 
visibility graph, and connect them to other vertices as appropriate. We can conveniently use 
this structure to determine the shortest obstacle-free path from the robot’s current position 
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to its goal. For simplicity, we will assume that the robot is a point, and can therefore pass 
between obstacles along a visible path. We first notice that if the start and goal positions 
are joined by an edge in the visibility graph, then the shortest path is simply the straight line 
joining the two. If they are not joined by an edge, Alt and Welzl [AIWe89] show by a simple 
geometric argument that the shortest path is a polygonal chain whose vertices are vertices 
of the obstacles. Since the robot’s path must be obstacle-free, the shortest path polygonal 
chain must also avoid obstacles. Consequently, pieces of the polygonal chain correspond 
to edges of the visibility graph. An assignment of Euclidean distance to the graph arcs 

allows the shortest path to be computed using Dijkstra’s algorithm in time 0(N ). 

We now examine the complexity of building the visibility graph. Let Vbe the set of 
obstacle vertices, and let £ be the set of obstacle edges. A straightforward approach would 
be to examine each pair of vertices in V to see if the line segment joining them intersects 

an edge in E. If N=IVI=I£I, then the algorithm compares O(N^) vertex pairs with 0(N) 

edges, and will run in time O(N^). We observe that not all pairs in V need to be considered, 
since vertices from the same obstacle will not be incident in the visibility graph unless they 

are connected by an edge in E. Still, this algorithm is O(N^) in the worst case. We will 
discuss in the next section how to first improve the algorithm to run in time 0(N logN), 

and then how to improve it to run in O(N^). We will also mention an interesting alternative 
to the visibility graph which can be used to solve the shortest path problem. 

2. Recent work 

The definition of the visibility graph and its optimal construction have remained 
fairly stable since the presentation by O’Rourke [OR87]. At that time, however, little was 
known about their characterizations from a graph-theoretical viewpoint. Most of the recent 
work concerning visibility graphs involves understanding these characterizations. We refer 
the reader to [LMW87] or [An92] for these results. 
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Still, it is worth noting the method used to improve the algorithm for constructing 
the visibility graph. The original idea is attributed to [Lee78], but is presented in [AlWe89] 
along with an improvement. We will present the main ideas of both algorithms here. Let 
p,q € V, the set of all obstacle vertices. Define visjp) to be the open ray emanating from 
p in direction and assign it a value based on which obstacle edge it encounters first. Now, 
pick an arbitrary direction Jq initialize vis^p) for all pe V. Next rotate d until d=n+dQ, 
while updating visjp). This continuous rotation is discretized by noting that visjp) is only 
updated if d is the same orientation as a line determined by p and some other vertex q. 
Additionally, the value of visjp) as it changes determines whether the edge pg belongs in 
the visibility graph. By sorting all pairs of vertices in V by the slope of their connecting 
lines, visjp) is only updated times. Determining the initial visjp) for all p€ V is 

accomplished easily in time O(N^), but this can be improved to O(NlogN). Sorting the 
vertex pairs takes 0(N logN) time. Each update of visjp) for the 0(N ) pairs can be 

processed in constant time. Therefore, the total running time of the algorithm is O(N^logN). 
The final improvement comes from the idea that a complete sorting of the vertex pairs is 
not necessary; a topological ordering is sufficient. Since this can be accomplished with 

amortized complexity of O(N^), the entire algorithm is reduced to 0(N^). This is optimal 
as the visibility graph may have O(N^) edges. 

We close this section by mentioning a variation of the shortest path problem that 
does not use the visibility graph. For a set of obstacles O and a point s, the shortest path 
map, denoted SPM(0,5), is a partition of the robot’s free space into regions such that any 
two points p and q lie in the same region if and only if the shortest paths from s\.o p and 
from sxoq touch the same sequence of vertices. If the initial position of the robot is s, and 
its goal is t, we can solve the shortest path problem as follows: Construct SPM(0,5), and 
then locate the region containing t. For the case of polygonal obstacles it has been shown 
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that this can be done in 0(N(K+logN)), where K is the number of obstacles. For large K 
this is O(N^), otherwise it is O(NlogN). 
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IV. CONNECTIVITY 



Kanayama [Ka94] discusses the sensitivity of visibility, proximity, and 
connectivity to small continuous changes of the robot’s operating environment. It is his 
conclusion that visibility is globally affected, proximity is locally affected, and 
connectivity is unaffected. Because of this, we prefer path planning methods which rely 
more on connectivity, and less on proximity and visibility. In the first part of this chapter 
we present a means of labeling homotopy classes considering only connectivity, and using 
minimal information. We then present a method of transforming the abstract problem of 
identifying the classes into a straight-forward graph search problem by adding additional 
information to the class names. 

A. IDENTIFYING HOMOTOPY CLASSES 

Consider a robot’s world W with a finite number n of normal holes. If there is no 
inverted hole, we assume the presence of one of sufficient size to minimize its influence on 
the proximity information of W. We also assume that the robot’s free space is path 
connected. Define a fence L to be a loop free curve connecting two holes which does not 
intersect a hole or another fence except at its endpoints. The idea is to add a maximal 
number of fences to the world, while maintaining the connectedness of the free space, so 
that we can use them to identify homotopy classes. If we consider the holes as nodes of a 
planar graph, and the fences as arcs, we know by Euler’s formula that we can add n fences 
to the n-Hl holes without dividing the freespace. We call this collection of holes and fences 
a connected world. Clearly, if the world has n>2 holes, then the construction of the 
connected world is not unique. Figure 2, on page 18, is an example of a connected world 
with two normal holes, and one inverted hole. Here, we have added the two fences a and b 
indicated by the dotted lines. Figure 2 also shows three paths from S to G, indicated by the 
solid lines. Each path represents a different path classes. Notice that two of the path classes 
are labeled by naming the fence that they cross, and the third by e since it does not cross a 
fence. 
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Figure 2; Connected World without Fence Modes 



If, however, we add a fourth path shown by the dashed line in Figure 3, then 
labeling the paths by fence crossing alone is not sufficient. Our solution is to redefine a 
fence so that it has two sides; a plus side and a minus side. If a path intersects a fence from 
the plus side, we say that it has plus intersecting mode. Likewise, if a path intersects a fence 
from the minus side, we say that it has minus intersecting mode. Now, we relabel each path 
class by the fence and intersecting mode. We call this class name the fence crossing 
sequence. Kanayama [Ka94] proves that two paths will have the same fence crossing 
sequence if and only if they are homotopic. 




Figure 3: Connected World with Fence Modes 



18 





Although this labeling method relies solely on the connectivity of the world, it 
provides very little path planning information. Our goal is a naming method which gives 
intermediate motion clues in addition to unique path class labels. In this case, there are just 
too many options for the robot to consider between fence crossings. Also, we want the robot 
to be able to generate the class names automatically. Unfortunately, there are no obvious 
rules which allow valid fence crossing sequences to be considered, and invalid sequences 
to be rejected. In the rest of this chapter, we describe how to augment the fence crossing 
sequence to meet these goals. 

B. FREE SPACE DECOMPOSITION 

Latombe [La91] proposes an approach to motion planning which he calls exact cell 
decomposition. This method divides the free space of the operating environment into a 
collection of non-intersecting regions, called cells. They are constructed so that intracell 
motion planning is an easier problem than motion planning within the entire free space. 
Since motion planning within a convex polygon eliminates the issue of visibility, and 
minimizes the issue of proximity, convex cells are desired. A decomposition of the free 
space in which all cells are convex, referred to as a convex polygonal decomposition, is 
preferred. While the basis for the following method is certainly not new [Chz87], we 
believe that its application extends beyond any presented in current literature. 

Let W be the subset of which is the robot’s world, or the space that we need to 
decompose. Let H be the set of holes within W, and let Vbe the set of all vertices of H. An 
efficient means of achieving a convex polygonal decomposition of W is to divide the free 
space by a series of parallel lines placed at certain critical points along the holes of H. This 
is accomplished by sweeping a line of constant orientation a across W. At each convex 
vertex of V, we extend the line in both directions (a and a+180) until it intersects a hole in 
W. The extensions can be characterized by the geometry of the vertex. 

We say that vertex v,- is less than vertex Vj, written V/ < vj, if intersects v, before 
Vj. In this case, we can also say that Vy is greater than vy (vy > vy). We say that vertex vy equals 
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Vj, written Vj = v,-, if encounters both vertices simultaneously. Recall from a previous 
discussion the definition of a vertex’s next and previous vertices. Define a minimal 
(maximal) extreme vertex ofh with respect to to be a vertex which is less than (greater 
than) both its next and previous vertices. Define an interior vertex of h with respect to 
to be any vertex that is not extreme. An interior vertex is called up if it is above the obstacle 
to which it belongs, and down if it is below. Furthermore, classify an extension of as up 
if it is extended in the a direction, and down if it is extended in the a +180 direction. 

Now consider v, a vertex of a hole h. If v is an extreme vertex of h, then will be 
extended both upward and downward. If v is an interior vertex of h, then will be 
extended upward or downward, but not both. is extended upward if v is up interior, and 
downward if v is down interior. The sole upward or downward extension from interior 
vertices is a consequence of immediately intersecting h in the other direction. 

Figure 4 , on page 21 , illustrates the effect of sweeping across a world with one 
normal hole and one inverted hole. In this example, the leading edge defined by vertices vj 
and V5 is parallel to therefore, vy and vg are interior vertices even though they are at the 
extreme of hj. When we extend from vy, it intersects hj immediately in the downward 
direction, and /12 in the upward direction. Conversely, the extensions from intersect hj 
immediately in the upward direction, and /12 in the downward direction. Vertices vj and vj, 
however, are exterior vertices, and have extensions in both directions. This example also 
illustrates why we do not extend from concave vertices. Note that vertices V2 and V4 are 
concave with respect to /ly, yet they are convex with respect to the free space of W. We can 
save work by skipping these vertices with the realization that they already contribute to the 
goal of obtaining convex polygonal cells. The result of sweeping across Wis a collection 

of convex polygonal cells, which we will simply call cells, and a collection of extensions, 
which we will call fences. 
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Figure 4: Results of sweeping across W 



A natural question to ask is whether the choice of orientation for is significant, 
and how changing the orientation affects the cell decomposition. Clearly, the number and 
shape of the cells may differ significantly for various choices of a. Consider the simple 
world in Figure 5, on page 22, which shows two separate decompositions; one produced by 
sweeping Lq (thin dotted line) and the other by L^q (thick dashed line). The Lq, or 
horizontal, decomposition contains five cells, while the L^q, or vertical, decomposition 
contains seven. This is intuitively explained by realizing that sweeps of different 
orientations capture different spatial information about the world. The top and bottom cells 
of the horizontal decomposition contain no vertical information about the holes hj and / 12 , 
whereas the middle cell of the vertical decomposition contains no horizontal information. 
By this we mean that knowing an object is located in the top (middle) cell of the horizontal 
(vertical) decomposition is not sufficient to describe its location with respect to the left or 
right (top or bottom) of holes h j and / 12 . 
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In general, any choice of might create ambiguous cells, or those that lack 
geometric information with respect to L^^’s orthogonal axis. The solution is to be able to 
identify these cells and then supplement them with additional information if necessary. 
There are two situations which cause the generation of ambiguous cells. We will describe 
both here, but defer the discussion of how they are treated until after we introduce the 
appropriate data structure and its application. 

The first form of ambiguous cell is that created between the trailing extreme vertex 
(or parallel edge) of one hole, and the leading extreme vertex (or parallel edge) of another. 
In a world with multiple holes, we can expect this situation to occur often. Two special 
cases of this form are always present when intersects the first normal hole, and when it 
leaves the last normal hole. In a world with a convex inverted hole, these appear as the first 
and last cell created. Fortunately, they are easy to detect and easy to fix. Figure 5, on page 
22 contains multiple instances of this problem. The top and bottom cell of the horizontal 
decomposition and the left-most and right-most cell of the vertical decomposition are 
special cases. The middle cell of the vertical decomposition is a standard example. 
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The second form of ambiguous cells occurs when encounters leading or trailing 
extreme vertices (or parallel edges) from multiple holes simultaneously. The top and 
bottom cells of the horizontal decomposition above are examples. In this case, however, 
they are also ambiguous cells of the first form. We are mainly concerned, though, with 
those cells that are only of the second form. These are less common, but still easy to 
identify, and in most cases can be eliminated by carefully choosing L„. 

It is not immediately apparent, then, whether one choice for is better than all 
others. Clearly, we would like to reduce the number of ambiguous cells by making a good 
choice for L„, but we do not want to spend too much effort finding it. We believe that this 
question requires further investigation. In the interim, we will always perform a vertical 
sweep. Sweeps of other orientations can be achieved by rotating the world, performing a 
vertical sweep, and then rotating the world back to its original position. 

C. CONNECTIVITY GRAPH 

The parallel cell decomposition induces a graph which we can use to extract some 
motion planning information. Latombe [La91 ] defines the connectivity graph for a convex 
polygonal decomposition by associating each cell with a node and connecting two nodes 
with an edge if and only if the corresponding cells are adjacent. Two cells are adjacent if 
they share a common fence. His use of the graph is restricted to determining the existence 
of an obstacle-free path within the robot’s world. We propose to expand its use and to apply 
it as a tool for generating all simple homotopy classes. 

Before we can use the connectivity graph, we must first assign labels to the nodes. 
Although any arbitrary assignment of labels is sufficient, we will use a more orderly 
approach. We will label each cell in the order of its inception. So for a vertical sweep, cells 
are labeled from left to right, and if two or more cells are created simultaneously, they are 
labeled from top to bottom. Additionally, there are two cells of special interest in every 
world; the one where the robot is currently located, and the one which contains its goal. 
They will be denoted by and respectively. In some cases, they may be the same. 
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Figure 6 is an example of the vertical parallel cell decomposition of a world with four 
normal holes and one inverted hole. Its associated connectivity graph is shown by the 
overlayed dotted line. 




D. AUTOMATIC PATH CLASS GENERATION 

We now describe how to use the connectivity graph to automatically generate 
homotopy classes. It should be obvious that each hole in a world will have at least four 
fences. As previously discussed, only one fence per hole is required to give the minimal 
information homotopy classes representation. For consistency, we will always choose this 
to be the downward fence from the leading extreme vertex. If the hole does not have such 
a vertex, we will choose the downward fence extending from the leading parallel edge. We 
will describe the fence and intersecting mode by naming the cell that the robot departs and 
enters as it crosses the fence. We call this the cell movement sequence. For example, from 
the graph in Figure 6, we see that the cell movement sequence describing the fence and 
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crossing modes associated with hj are Cj-Cj and cyCj. It should also be obvious that any 

path from the robot’s initial configuration to its goal can be described by a chain of cell 
movement sequences, called the complete cell movement 

sequence. Note that the complete cell movement sequence contains an embedded fence 
crossing sequence, and can therefore be used to represent a homotopy class. 

Since any complete cell movement sequence from c,„,7 to Cg^^i uniquely defines a 
homotopy class, we can search the connectivity graph to find all possible paths and thus 
generate all path classes. We must first, however, define some stopping criteria for the 
search. Recall that we are only interested in evaluating simple paths. This means that, for 
most cells in the decomposition, once the robot leaves it should not return. Unfortunately, 
this is not true for some cells, specifically ambiguous cells. Consider a robot located at the 
bottom of cell in Figure 6, on page 24 , which needs to move to the top of cell c^. Suppose 

the robot is too wide to fit through the gap between h ; and /14. If we do not allow the robot 
to reenter a cell once it departs, the path class given by c^-C4-cyCi~C2~C4 would not be 
considered. Clearly, this should be one of the alternatives. At first we might consider 
relaxing the “visit once” criteria for C4, but this would lead to consideration of the class 
given by c^~C4-C2-Cj-cyC4, which clearly is not simple. We must, therefore, eliminate the 
ambiguity in these cells in order to apply the stopping criteria uniformly. 

The first step is to identify ambiguous cells created by the parallel decomposition. 
Again, the connectivity graph provides a useful tool. From an earlier discussion, we know 
that cells Cy and Cyy are special cases of ambiguous cells, and can be identified immediately 
without the graph. We can also see that cell q is a standard example of the first form, and 
cj is an example of the second. Additionally, we note that they correspond to nodes of the 
connectivity graph of degree greater than three. It should be obvious that having degree 
greater than three is sufficient for being an ambiguous cell by the very nature of their 
construction. If it is also necessary, then identifying such cells is trivial. 
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Unfortunately, it is not generally necessary for a cell of degree four or more to be 
ambiguous. Consider, again, the example in Figure 6. Suppose that holes /12 and /ij were 
connected by the fence between cells and cjq, and were really one large hole. The only 
change to the connectivity graph would be the removal of the arc from cg to cjq. Now, cell 
C5 still has degree four, but no longer falls under the definition of an ambiguous cell. We 
would not want any path to enter C5 more than once. Nevertheless, we can use the 
connectivity graph to identify candidate cells, and then examine how they were constructed 
to verify if they are indeed ambiguous. 

Since an ambiguous cell is one which does not contain geometric information about 
Lot’s orthogonal axis, it would seem natural to add this information with a supplemental 
sweep by Lp = L^+po. We conduct the sweep in much the same way as the initial 
decomposition, except now we only sweep selected cells. At each extreme vertex defining 
the ambiguous cell, we extend Lp in both directions until it intersects a hole or a fence. If 
the cell was defined by one or more parallel edges, then we extend Lp from any point along 
each edge. For consistency, we will use the midpoint. This divides the original cell into at 
most n+1 convex pieces, where n is the number of holes which defined the cell. The new 
convex pieces are called sub-cells. Figure 7 shows the results of the supplemental sweep. 
The new fences are indicated by thin dotted lines. 

We must now relabel the sub-cells and reconstruct the connectivity graph. In order 
to preserve the information contained in the original graph, we will name the sub-cells in 
the order in which they were created by adding a suffix to their old label. We also want to 
add sub-cell adjacency arcs while maintaining the original adjacency information. We 
preserve the original adjacency information by adding only one arc between cells that were 
adjacent in the original decomposition. For example, is adjacent to both 04/^ and 
yet we only add one arc from C5 to C4. It does not matter which arc is added, as long as the 
sub-cells within these cells are adjacent. Adding all sub-cell adjacency arcs would destroy 
the bijection between homotopy classes and complete cell movement sequences. 
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Figure 7: Supplemental Sweep of Ambiguous Cells 



Now we see that we can define a simple path to be one that enters a sub-cell or cell 
only once. A simple path for the robot, then, corresponds to a simple path on the graph. 
Moreover, to find all simple path classes for the robot, we need only search the graph for 
all simple paths. We propose using a depth first search starting at and terminating at 

Cgoai- We can apply a simple backtracking strategy to find all simple paths. 

The complete set of path classes is passed to the next layer of the motion planning 
algorithm, where a class is selected and a detailed motion plan is formed. We present the 
specific decomposition and graph search implementations in the next chapter. 
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V. IMPLEMENTATION ON YAMABICO 



A. 2-DIMENSIONAL GEOMETRIC MODEL OF A ROBOT’S WORLD 

We propose to represent the robot’s world by specifying the vertices of the 
polygonal holes. Each hole, then, becomes an ordered list of vertices such that traversing 
the list corresponds to traversing the hole’s boundary with the free space on the right. In 
other words, vertices of regular holes are ordered counter-clockwise, while vertices of 
inverted holes are ordered clockwise. Since information is commonly needed about a 
vertex’s neighbors, the specific data structure must be able to efficiently identify its next 
and previous vertices. Storing the vertices in a doubly linked list is one alternative. In this 
chapter we will describe the world of our robot, Yamabico, and provide specific details of 
how we implement the model and theory discussed earlier. 

B. ALGORITHMS AND DATA STRUCTURES 

The code for the implementation discussed in this chapter is attached as an 
appendix. It is also available in the yamabico account under the graduates subdirectory. 
Currently, building and decomposing the world model is preprocessed on a Unix 
workstation with the same architecture as Yamabico. We are investigating, however, the 
possibility of creating these structures using the robot’s processor. By processing them on 
board, we gain the ability to relocate Yamabico without recompiling and redownloading 
the entire kernel. 

1. World Model 

Yamabico’s world is stored as a circularly linked list of polygons, where each 
polygon is a doubly linked list of its vertices. Access to the world is gained through a 
pointer to one of the polygons on the list. The file build.h contains the definitions for the 
actual C structures used, while Figure 8 gives a graphical representation. 
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Figure 8; Representation of World Model 



Initially, the vertex information is stored as an ASCII file. The function buildWorld 
in the file build.c reads the vertices one at a time, and constructs the linked structure 
described above. This structure is then used for two purposes. The first is to create a file 
which explicitly defines every polygon and every vertex variable, along with an 
initialization function to assign them the correct value. This new file is compiled and linked 
with the robot’s kernel. The file worlddata.c is an example. The decomposition function 
also uses the constructed world model to build the cells and connectivity graph. These 
processes are described below. 

2. Cell Decomposition 

One of the goals of the data structure used to represent the decomposition of the 
robot’s free space is to answer these two questions efficiently: Whether an edge defines the 
boundary of a hole, or whether it defines a fence crossing; and in which cell is the robot 
currently located. Additionally, it is reasonable for the robot’s global motion planner to 
expect that different representations of the free space be consistent. Therefore, we propose 
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to represent the decomposed world by specifying the vertices of the cells. Specifically, we 
will model each cell as an inverted hole, with its boundary determined by a combination of 
obstacles and fences. In this way, any intracell motion planning can be accomplished as if 
the robot were located in an obstacle-free convex world. Intercell motion is permitted by 
allowing the robot to cross cell boundaries which are defined by fences. The complete 
representation of the decomposed world is a circularly linked list consisting only of cells; 
obstacles are implicitly defined by a subset of the cell boundaries. 

The decomposition is achieved by sweeping a vertical line across the original world 
using the ideas presented in [La91]. Sweeps of orientations other than 90 degrees are 
accomplished by rotating the world, conducting a vertical sweep, and then rotating the 
world back to its original configuration. The continuous sweep is discretized by realizing 
that cells are created or completed only at obstacle vertices, and that they are only affected 
by obstacle edges which have non-empty intersection with the sweep tine. This 
immediately defines the need for two data structures: a list of events, which are the vertices 
ordered by x-coordinate, and a list of those edges which intersect the sweep line. The event 
list is static for a given world, but the edge list changes at each event. We can, therefore, 
create the event list as we read in the initial world data. Events are maintained as pointers 
to vertices, and are properly placed on the event list using a simple linear insertion. The 
sweep is performed by the algorithms shown in Figures 9 through 13. 

We refer the reader to the actual code for the precise implementation details, but 
make some explanatory notes here. For simplicity, we show the main algorithm assuming 
that the sweep line only encounters one event at a time. The actual program handles the 
general case where the sweep line may encounter multiple events simultaneously. Also, the 
active edge list is maintained so that edges are ordered by decreasing y-coordinate of then- 
intersection with the sweep line. This allows us to quickly locate the edge which first 
intersects the fence as it is extended from the current event vertex. These algorithms are 
implemented in the files decompose. c and decomposutil.c. 
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ALGORITHM DECOMPOSE WORLD 

INPUT: Event list sorted by x-coordinate; Model of robot’s world 

OUTPUT: Model of robot’s world represented as convex cells 

begin 

while event list is not empty 

currentEvent <- next Event from Event List 

ADD EDGES TO ACTIVE LIST; 

FINISH COMPLETED CELLS; 

START NEW CELLS; 

REMOVE EDGES FROM ACTIVE LIST; 

end while; 

end DECOMPOSE WORLD 



Figure 9: Algorithm DECOMPOSE WORLD 



ALGORITHM ADD EDGES TO ACTIVE LIST 
INPUT: Event 

OUTPUT: Updated Active Edge List 
begin 

currentVertex <- vertex pointed to by currentEvent 

if x-coordinate of currentVertex’s next vertex > x-coordinate of currentVertex then 
add edge defined by currentVertex and currentVertex’s next vertex 
to Active Edge List in the proper order 

if x-coordinate of currentVertex’s previous vertex > x-coordinate of currentVertex 
then 

add edge defined by currentVertex and currentVertex’s previous vertex 
to Active Edge List in the proper order 

end ADD EDGES TO ACTIVE LIST 



Figure 10: Algorithm ADD EDGES TO ACTIVE LIST 
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ALGORITHM COMPLETE CELL 
INPUT: Event 

OUTPUT: Complete cell added to \«orld model, Updated Cell in Progress List 
begin 

currentVertex vertex pointed to by currentEvent 
if currentVertex is convex minimal extreme 
complete cell UP/DOWN 
elsif currentVertex is convex maximal extreme 
complete cell UP 
complete cell DOWN 
elsif currentVertex is convex interior up 
complete cell UP 

elsif currentVertex is convex interior do\wn 
complete cell DOWN 

elsif currentVertex is concave maximal extreme 
complete ISOLATED cell 
elsif currentVertex is concave interior 
extend cell 

end COMPLETE CELL 



Figure 11: Algorithm COMPLETE CELL 



ALGORITHM START NEW CELL 
INPUT: Event 

OUTPUT: Updated Cells in Progress List 
begin 

currentVertex <— vertex pointed to by currentEvent 
if currentVertex is convex minimal extreme 
start new cell UP 
start new cell DOWN 

elsif currentVertex is convex maximal extreme 
start new cell UP/DOWN 
elsif currentVertex is convex interior up 
start new cell UP 

elsif currentVertex is convex interior down 
start new cell DOWN 

elsif currentVertex is concave minimal extreme 
star new ISOLATED cell 

end START NEW CELL 

Figure 12: Algorithm START NEW CELL 
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ALGORITHM DELETE EDGES FROM ACTIVE LIST 
INPUT; Event 

OUTPUT: Updated Active Edge List 
begin 

currentVertex «- vertex pointed to by currentEvent 

for each Edge on Active Edge List 

if x-coordinate of currentVertex = x-coordinate of Edge’s trailing vertex then 
remove edge from Active Edge List 

end for 

end DELETE EDGES FROM ACTIVE LIST 

Figure 13: Algorithm DELETE EDGES FROM ACTIVE LIST 

3. Connectivity Graph 

We generate the connectivity graph as a by-product of the decomposition sweep. 
The graph is maintained as an adjacency list. Nodes of the graph are added when a cell is 
started. As a cell is completed, the vertical fence which defines its rightmost boundary is 
placed on a temporary holding list. Then, as the algorithm enters the start new cell phase, 
the leftmost boundary of each new cell is compared with the boundaries on the holding list. 
Two boundaries will match if the cells are adjacent. Once adjacency of two cells is 
determined, both nodes on the graph are updated. 

4. Determining Cell of Current and Goal Configurations 

If the initial and goal configurations are known before the world is decomposed, the 
cell in which they are located can be determined as part of the sweep. Since the world is 
presently decomposed off line, however, we will assume that neither location is known. 
The first step in identifying the homotopy classes, then, is to identify the cell containing the 
robot’s initial position and the cell containing the goal. Once the robot has this information. 
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it should be able to keep its current cell location updated by using odometry control. Still, 
it may be necessary for the robot to verify this information. 

Preparata and Shamos [PrSh85] present two algorithms for determining whether a 
point lies within the interior of a simple N-gon. Including preprocessing, each takes 0(N) 
time. Since we are concerned with only convex cells, we have adapted the more restrictive 
convex inclusion algorithm. It is based on the fact that for any point p interior to a convex 
polygon, and for any two vertices V] and V 2 of that polygon, the angle formed by the two 
rays pvj and pv 2 is positive, if V 2 is reached from V] while traveling the polygon’s border 
in its natural direction. Now, if for each vertex V| and its next vertex V 2 , this angle is 
positive, we know that p lies within the polygon. We can use the algorithm in Figure 14, to 
find the cell of the initial and goal configurations, and the algorithm in Figure 15, to verify 
that the robot is located within a specific cell. 



ALGORITHM FIND CELL 

INPUT; Configuration, Decomposed Model of robot’s world 
OUTPUT: Cell which contains Configuration 

begin 

while all cells not checked 

currentCell <- next cell not checked 

if INSIDE CELL (currentCell) 

Configuration is located within currentCell 

end while 

ERROR: Configuration is not located within robot’s world 
end FIND CELL 

Figure 14: Algorithm FIND CELL 
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ALGORITHM INSIDE CELL 
INPUT: Configuration, Convex cell 

OUTPUT; TRUE if Configuration is within Convex Ceil, FALSE othenwise 
begin 

while all vertices not checked 

currentVertex <- currentVertex’s next vertex 

if Configuration, currentVertex, and currentVertex’s next Vertex make a right turn 
continue; 
else 

return FALSE; 
end if 

end while 

return TRUE; 

end INSIDE CELL 



Figure 15: Algorithm INSIDE CELL 



5. Finding All Homotopy Classes 

Once we know the cell containing the robot’s configuration, and the cell containing 
the goal configuration, we can apply a depth-first search with backtracking to the 
connectivity graph to find all simply homotopy classes. We will use the algorithm in 
Figures 16 and 17, to find all classes, and to give their complete cell movement sequence 
representation. 

We mention, here, an alternative to searching the graph for all homotopy classes, 
but we neither develop it in this thesis nor presently implement it on Yamabico. We begin 
by applying edge weights to the graph using a criteria based on the cost of moving from 
one cell to the other. Then, we can use Dijkastra’s algorithm to search the graph for the path 
of minimal cost. Two possible cost factors to consider are the length of the path segment, 
and the clearance between obstacles. Unfortunately, it appears to be a very difficult 
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problem to find the exact cost for a cell movement sequence. We could use, instead, a good 
approximation to find a near-optimal solution. 



ALGORITHM FIND PATHS 

INPUT; Connectivity Graph, Cell of Goal Configuration, Cell of Robot's Configuration 
OUTPUT: Complete cell movement sequence of each homotopy class 

begin 

if Robot and Goal are in the same cell 
return NULL path class 

initialize all predecessors to NILL 
CG 4- Connectivity Graph 
s <- Cell of Robot’s Configuration 
g Cell of Goal Configuration 
DFS(CG, s, g) 

end FIND PATHS 



Figure 16: Algorithm FEND PATHS 



ALGORITHM DFS 

INPUT: Connectivity Graph, u, v vertices in Connectivity Graph 
OUTPUT: Complete cell movement sequence of a homotopy class 

begin 

if u = V 

return path class by tracing predecessors 

else 

for all vertices x which are adjacent to u do 

if predecessor of x = NIL 
mark predecessor of x = u 
DFS(CG,x,v) 

mark predecessor of x = NIL 
end FIND PATHS 



Figure 17: Algorithm DFS 
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C. INTEGRATION WITH MML 

Yamabico’s global motion planner has been mentioned several times in this 
chapter. Currently, the complete system is under development by Chien-Liang Chuang and 
Joseph Kovalchick, PhD candidates at the Naval Postgraduate School. When completed, it 
will provide the main interface as part of the model-based mobile robot language (mml). 
The work done in this thesis will primarily be a subset of the inner workings of the global 
motion planner. We can, however, provide some limited integration now. 

We hide the details of the world model by providing access through a pointer to the 
world structure. The world structure, then, is linked to one of the polygons. Multiple 
representations of the same world can be present simultaneously. Each, though, are 
independent and share no information. Presently, the only interface to the world models is 
through the configuration-cell location functions. As the global motion planner evolves, 
more interface functions must be provided. 
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VI. CONCLUSION 



A. RESULTS 

Without the global motion planner, it is hard to test and validate the theory 
described in this thesis. Fortunately, that work is underway. Still, we believe that the ideas 
and implementation presented here will provide a solid framework for future work. We 
have been able to graphically analyze the decomposition process, and evaluate the 
generation of the connectivity graph. The functions that will provide the initial interface 
between the global planner and the robot’s world model have all been tested on board 
Yamabico. The results are a reliable first layer to what will be a robust, multi-layer, 
autonomous motion planner. 

B. AREAS OF FURTHER RESEARCH 

While the parallel cell decomposition provides a good beginning for the global 
motion planner, it has left some questions unanswered, and raised others. We present three 
of them here; two relating to the theory of our layered path planning paradigm, and one 
relating to the implementation on Yamabico. 

1. Orientation of 

We mentioned previously that the generation of some ambiguous cells could be 
avoided by carefully choosing Furthermore, some worlds may be better suited for a 
sweep by one orientation over another. This leads us to the question of whether we can 
efficiently determine if one orientation of is better than another for a given world. 
Consider the world and the two decompositions in Figure 18, on page 40, which is similar 
to a portion of the 5th floor of Spanagel Hall. We notice that the horizontal decomposition 
creates many more cells than the vertical decomposition. On the one hand, we end up 
further decomposing many of the classrooms which were already convex. On the other 
hand, though, we get many more motion clues as we move along the long hallway. It seems 
apparent that the two decompositions shown are better than any other, but we do not know 
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for sure. Also, how can we decide if the additional information provided in the hallway is 
worth the extraneous information added to the classrooms. We leave this as an open 
question, but use it to provide, perhaps, some insight into a solution to another problem. 




2. Ambiguous Cells 

While the generation of some ambiguous cells can be avoided with a particular 
choice of we realize that generally some will still be created. This is inherent in the fact 
that for a given sweep, we only preserve spatial information in one orientation. The method 
we proposed of limiting a supplemental orthogonal sweep to the ambiguous cells is 
acceptable, but this still raises some questions. Primarily, we are uneasy with the idea that 
this method favors one orientation over another. We investigated the possibility of fully 
decomposing the world using a set of orthogonal sweeps, and generating a corresponding 
set of connectivity graphs. The idea was to independently find all homotopy classes with 
both graphs, and provide the lower layers of the global motion planner a pair of cell 
movement sequences for each class. This approach has two benefits. First, we end up 
treating both orientations equally. Second, we provide additional motion clues that would 
be missing from a single sweep. In the example from Figure 1 8, the second sweep would 
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allow the global motion planner to use the additional cells in the hallway, while 
disregarding them in the classrooms. 

Unfortunately, we encountered a problem with this approach. For a world with 
multiple homotopy classes, we are still unsure how to accurately make the pairings. It is 
easy for a human to match a simple path on one graph with a simple path on the other, but 
as of yet, we have not found a method to do it autonomously. 

3. Downloading the World Model 

Currently, the model for the robot’s world and the decomposition are transformed 
into C files, compiled, and linked into the robot’s kernel. This method will cause us to 
relink and redownload the kernel every time we want to change the robot’s world. A better 
solution would be to allow Yamabico to build and decompose the world on board. Then, it 
needs only download the new vertex information when relocated. We are presently 
investigating a method for storing the ASCII world information in RAM onboard 
Yamabico, which will allow us to move the construction and decomposition from the 
workstation to the robot. 
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APPENDIX A 



A. MAIN 

1. main.c 

r 

FILE: main.c 

PURPOSE: This file contains the main function which parses the command 
line and then calls the decompose functions 
/ 



#include <stdio.h> 
#include <stdlib.h> 
#include <string.h> 
#include <math.h> 
#include “util.h” 

#include “build. h” 

#include “decompose.h” 
#include “worldfile.h” 

int 

main(int argc, char* argvQ) 

{ 



FILE* plotFile; 

FILE* worldFile; 

world* testWorld; 
world* decompWorld; 
polygon* curPolygon; 
vertex* curVertex; 
event* eventList; 
event* currentEvent; 

node* cGraph; 

int numberOf Sweeps; 
int counter; 
double sweepAngle; 
double cosRotInv; 
double sinRotInv; 
double rotX, rotY; 

char worldTagfT]; 
char filename[21]; 



eventList = NULL; 
cGraph = NULL; 
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decompWorld = NULL; 



r This block of code parses the command line to ensure it is correct*/ 
if (argc < 2){ 

printf(“\nYou must supply the name of the file containing\n”); 
printf(“the vertices of the robot’s worldXn"); 
return -1; 

}else if (argc < 3){ 
numberOf Sweeps = 1; 
sweepAngle = 90.0; 

}else if ((numberOfSweeps = atoi(argv[2])) > 0){ 
if (argc != (numbetOfSweeps + 3)){ 

printf("\n%d sweeps specified, but %d angles given\n”, 
numberOfSweeps, (argc - 3)); 
return -4; 

} 

for (counter = 1 ; counter <= numberOfSweeps; counter++){ 
sweepAngle = atof(argv[2+counter]); 
if ((sweepAngle <= 0.0) II (sweepAngle > 180.0)){ 
printf(An %Sweep angle must be in the range (0.0-1 80.0]\n"); 
return -2; 

} 

} 

}else{ 

printf(Anlnvalid commandline options. Correct format is:\n”); 
printf(“DecomposeWorld filename [# of sweeps] [sweep anglesjXn”); 
return -3; 

} 

r read in the world datafile, build the structures for the 
original world model, and create the outputfile */ 

if((testWorld = buildWorld(argv[1], 90, &eventList)) == NULL){ 
return -3; Tfile does not exist, or contains an error*/ 

}else( 

createWorldFile(testWorld,NULL, “originalworld.c",90,0.'’0’’); 

} 

r Decompose the world for every sweep angle specified as a 
command line parameter*/ 

for (counter = 1; counter <= numberOfSweeps; counter++){ 
if (argc>2) 

sweepAngle = atof(argv(2+counterj); 
sprintf(worldTag,”%3.2r, sweepAngle); 

(*strchr(worldTag, ’.’))=’_’; 

freeWorld(&testWorld,&decompWorld,&eventList,&cGraph); 
testWorld = buildWorld(argv[1],sweepAngle, SeventList); 
decompWorld = decompose(eventList, ScGraph); 
sprintf(filename,”decompworld_7oS.c",worldTag); 
createWorldFile(decompWorld,cGraph,filename,sweepAngle,counter,worldTag); 
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r If only one decomposition was specified, create a file which can 
be used by GnuPlot to graphically show the cells */ 
if (argc <= 4){ 

cosRotInv = cos((-(M_Pr(90.0-sweepAngle)))/180.0); 
sinRotInv = sin((-(M_PI*(90.0-sweepAngle)))/180.0); 

curPolygon = decompWorld ->polygonList; 

plotFile = fopenfplot.daf.'w”); 

do{ 

fprintf(plotFile,"#Cell %s vertices\n”,curPolygon->name); 

curVertex = curPolygon->vertexList; 

do{ 

r***"re-rotate" the vertices******/ 

rotX = ((curVertex->posit.X*cosRotlnv)-(curVertex->posit.Y*sinRotlnv)); 
rotY = ((curVertex->posit.X*sinRotlnv)+(curVertex->posit.Y*cosRotlnv)); 
fprintf(plotFile,”%4.2f %4.2f\n", rotX, rotY); 
curVertex = curVertex->next; 

)while (curVertex!= curPolygon->vertexList); 

rotX = ((curVertex->posit.X*cosRotlnv)-(curVertex->posit.Y*sinRotlnv)); 
rotY = ((curVertex->posit.X*sinRotlnv)+(curVertex->posit.Y*cosRotlnv)); 
fprintf(plotFile,”%4.2f %4.2f \n\n”, rotX, rotY); 
curPolygon = curPolygon->next; 

}while (curPolygon != decompWorld->polygonList); 
fclose(plotFile); 

printf(“Your plot data is located in plot.dat\n" ); 



return 1 ; 



) 



B. BUILD 

1. build.h 



/* 

FILE: build.h 

PURPOSE: This file contains the definitions for the types used in 
the world model. 

******* * / 



#ifndef build_h 

#define build_h 



typedef struct point{ 
double X; 
double Y; 

}point; 

typedef struct vertex{ 
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point posit; 
char bndry[5]; 
struct vertex* next; 
struct vertex* prev; 

}vertex; 

typedef struct polygon{ 
char name[5]; 
int mode; 
vertex* vertexList; 

vertex* openi ; /*used while constructing cells*/ 
vertex* open2; /*used while constructing cells*/ 
struct polygon* next; 

}polygon; 

typedef struct world{ 
char name[15]; 
polygon* polygonList; 

}world; 

typedef struct event{ 
vertex* eVertex; 
struct event* next; 
polygon* owner; 

}event; 



typedef struct arc{ 
struct node* Node; 
struct arc* next; 
double weight; 
int visited; 

)arc; 



typedef struct node{ 
polygon* cell; 
arc* arcList; 

struct node* predecessor; 
struct node* next; 
arc* curArc; 

}node; 



double, event**)****************** 
This function reads the ASCII vertex information in the inputfile, 
rotates the world by decompostion angle, and orders the 
vertices to create the event list. It returns a pointer 
to the world. 

***** / 



world* buildWorld(char*, double, event**); 



#endif 
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2 . 



build.c 



r 

FILE: build.c 

PURPOSE: This file contains the function which reads in the ASCII 
vertex information and creates the linked list structure 
defined by the world model. 

7 



#include <stdio.h> 
#include <stdlib.h> 
#include <math.h> 
#include <ctype.h> 
#include “util.h” 

#include “build. h" 
#include “decompose. h" 



world* 

buildWorld(char* fileName, double rot. event** eventList) 

{ 



FILE* inputFile; 
char ch; 

world* currentWorld; 
polygon* currentPolygon; 
vertex* currentVertex; 
vertex* previousVertex; 

double tempX; 
double tempY; 
double cosRot; 
double sinRot; 

event* newEvent; 
event* currentEvent; 
event* previousEvent; 

rWe rotate the world to achieve sweeps other than vertical, here 
we calculate the trig functions for the rotation transformation*/ 
rot = (M_PI * (90.0-rot))/180.0; 
cosRot = cos(rot): 
sinRot = sin(rot): 

if ((inputFile = fopen(fileName, “r")) == NULL){ 
printf(‘ViCould not open named file: %s\n", fileName); 
return NULL; 

} 

currentWorld = (world*)malloc(sizeof(world)); 



49 



currentPolygon = currentWorld->polygonList = 

(polygon*) malloc(sizeof(polygon)); 

getName(inputFile, currentWorld->name, 15); 

while(1){/*loop until all polygons are read*/ 

getName(inputFile, currentPolygon->name,5); 
fscanf(inputFile,"%d(“,&currentPolygon->mode): 

currentVertex = currentPolygon->vertexList = 
(vertex*)malloc(sizeof(vertex)); 

while(1){rioop until all vertices for this polygon are read*/ 

fscanf(inputFile,”%lf,%lf)”,&tempX, &tempY); 

/*rotate vertices of world depending on sweep angle*/ 
(currentVertex->posit.X)= ((tempX*cosRot)-(tempY*sinRot)); 
(currentVertex->posit.Y)= ((tempX*sinRot)+(tempY*cosRot)); 

rbuilding event list*/ 
if ((*eventList) == NULL){ 

(*eventList) = (event*)malloc(sizeof(event)); 

CeventList)->eVertex = currentVertex; 

(*eventList)->owner = currentPoiygon; 

(*eventList)->next = NULL; 

}else{ 

newEvent = (event*)malioc(sizeof(event)); 
currentEvent = (*eventList); 
previousEvent = (*eventList); 
while ((currentEvent) && 

((currentVertex->posit.X > currentEvent->eVertex->posit.X) II 
((currentVertex->posit.X == currentEvent->eVertex->posit.X) && 
(currentVertex->posit.Y < currentEvent->eVertex->posit.Y)))){ 
previousEvent = currentEvent; 
currentEvent = currentEvent->next;} 

newEvent->next = currentEvent; 
if(currentEvent == (*eventList)) 

(*eventList) = newEvent; 
else 

previousEvent->next = newEvent; 

newEvent->eVertex=currentVerlex; 
newEvent->owner = currentPolygon; 

} 

/*end building event list */ 
do 
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ch = getc(inputFile); 
while(isspace(ch)); 
if (ch == •)') 

break; Tlast vertex read for this polygon*/ 
else if (ch != ■(•){ 
fclose(inputFile); 

fprintf(“\nError in vertex data file\n”); 
return NULL; 

}else{ /*read in left paren of next vertex*/ 
currentVertex->next=(vertex*)malloc(sizeof(vertex)); 
previousVertex = currentVertex; 
currentVertex = currentVertex->next; 
currentVertex->prev = previousVertex; 

} 

}/*end vertex while loop*/ 

currentVertex->next = currentPolygon->vertexList; 
currentPolygon->vertexList->prev = currentVertex; 

do 

ch = getc(inputFile); 
while(isspace(ch)); 
if (ch == ')’){/*last polygon read*/ 
currentPolygon->next = currentWorld->polygonList; 
fclose(inputFile); 
return currentWorld; 

}else {/* read in first character of next polygon name */ 
ungetc(ch,inputFile); 

currentPolygon->next = (polygon*)malloc(sizeof(polygon)); 
currentPolygon = currentPolygon->next; 

} 

}/*end polygon while loop*/ 

} 

DECOMPOSE 
1. decompose.h 



/* ***** 

FILE: decompose.h 

PURPOSE: This file contains the prototype for the function which 
examines the the vertices of the world and determines what 
action to take in the following areas: 

adding edges, deleting edges, starting cells, 
and finishing cells. 

*** / 



#ifndef decompose.h 

#define decompose.h 



#include “build.h' 



world* decompose( event*, node**); 
#endif 



2. decompose.c 



r 



FILE: decompose.c 

PURPOSE: This file contains the function which examines the the vertices 
of the world and determines what action to take in the 
following areas: adding edges, deleting edges, starting cells, 
and finishing cells. 
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#include <stdio.h> 
#include <stdlib.h> 
#include "build.h” 
#include “decompose.h” 
#include “util.h" 

#include “decomputil.h” 



int cellCount; 
world* 

decompose(event* eventList, node** cGraph) 

{ 



world* robotsWorld; 

edge* activeEdges; 
edge* cEdge; 
event* currentEvent; 
event* simulEvent; 
polygon* cellList; 
fence* activeFences; 



robotsWorld = malloc(sizeof(world)); 
robotsWorld->polygonList = NULL; 
activeEdges = NULL; 
cellList = NULL; 
cellCount = 0; 
activeEdges = NULL; 
activeFences = NULL; 
currentEvent = eventList; 
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while(currentEvent){ 

/ ADD EDGES LOOP 7 

simul Event = currentEvent; 
do{ 

addEdge(simulEvent, &activeEdges); 
simulEvent = simulEvent->next; 

}while((simul Event) && 

(currentEvent->eVertex->posit.X == simulEvent->eVertex->posit.X)); 

r FINISH CELLS LOOP 7 

simulEvent = currentEvent; 
do{ 

if (simulEvent->eVertex->bndry[0)==’V’)rconvex vertex7 

{ 



if ({simulEvent->eVertex->posit.X > simulEvent->eVertex->next->posit.X) 
&&(simulEvent->eVertex->posit.X <= simulEvent->eVertex->prev->posit.X)) 
/* this is an up interior convex vertex7 

{ 

if (simulEvent->eVertex->bndry[1]==’0’)/*only vertex7 
finishCellUp(simulEvent, &cellList, 

activeEdges.&robotsWorld, SactiveFences); 



}else 

if ((simulEvent->eVertex->posit.X < simulEvent->eVertex->next->posit.X) 
&&(simulEvent->eVertex->posit.X > simulEvent->eVertex->prev->posit.X)) 
/* this is a down exterior convex vertex7 

{ 

finishCellDown(simulEvent, &cellList. 

activeEdges.&robotsWorld, &activeFences, 0); 



}else 

if ((simulEvent->eVertex->posit.X <= simulEvent->eVertex->next->posit.X) 
&&(simulEvent->eVertex->posit.X < simulEvent->eVertex->prev->posit.X)) 

{ 

/* this is a minimal exterior convex vertex7 
if (simulEvent->eVertex->bndry[1]==’0’)/’only vertex7 
finishCellUpDownfsimulEvent, &cellList, 

activeEdges.&robotsWorld, &activeFences); 



}else 

if ({simulEvent->eVertex->posit.X >= simulEvent->eVertex->next->posit.X) 
&&(simulEvent->eVertex->posit.X > simulEvent->eVertex->prev->posit.X)) 

{ 

r this is a maximal exterior convex vertex7 
if (simulEvent->eVertex->bndry[1]==’0’)/’only vertex7 
finishCellUp(simulEvent, &cellList, 
activeEdges.&robotsWorld, &activeFences); 
finishCellDown(simulEvent, &cellList, 
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activeEdges.&robotsWorld. &activeFences, 0); 



} 

}else{r concave vertex*/ 

if ((simulEvent->eVertex->posit.X > simulEvent->eVertex->nex1->posit.X) 
&&(simulEvent->eVertex->posit.X >= simulEvent->eVertex->prev->posit.X)) 
{ 

r this is a maximal extreme concave vertex*/ 
if (simulEvent->eVertex*>bndry[1)=’0’)/*only vertex*/ 
finishCelllsolated(simulEvent, &cellList, SrobotsWorld); 

}else 

if ((simulEvent->eVertex->posit.X < simulEvent->eVertex->next->posit.X) 
&&(simulEvent->eVertex->posit.X > simulEvent->eVertex*>prev->posit.X)) 

{ 

r this is an interior concave vertex*/ 
if ((simulEvent->eVertex->bndry(1]==’0’) && (cellList)) 
extendCell(simul Event, &cellList);/*only vertex*/ 

}else 

if ((simulEvent->eVertex->posit.X == simulEvent->eVertex->next->posit.X) 
&&(simulEvent->eVertex->posit.X > simulEvent->eVertex->prev->posit.X)){ 
r this is a lower right corner*/ 
finishCellDown(simulEvent, &cellList, activeEdges, 

&robotsWorld, SactiveFences, 1); 



} 

} 

simulEvent = simulEvent->next; 

}while((simulEvent) && 

(currentEvent->eVertex->posit.X == simulEvent->eVertex->posit.X)); 

simulEvent = currentEvent; 

/ START CELLS LOOP / 

do{ 

if (simulEvent->eVertex->bndry[0]==’V’)/*convex vertex*/ 

{ 



if ((simulEvent->eVertex->posit.X >= simulEvent->eVertex->next->posit.X) 
&&(simulEvent->eVertex->posit.X < simulEvent->eVertex->prev->posit.X)) 
/*this is an up interior convex vertex*/ 

{ 

if (simulEvent->eVertex->bndry{1]==’0’)/*only vertex*/ 
startCellUp(simulEvent, &cellList, activeEdges, 

SactiveFences, cGraph); 



}else 

if ((simulEvent->eVertex->posit.X < simulEvent*>eVertex->next->posit.X) 
&&(simulEvent->eVertex->posit.X >= simulEvent->eVertex->prev->posit.X)) 
/* this is a down exterior convex vertex*/ 
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{ 



startCellDown(simulEvent, &cellList, 

activeEdges, &activeFences, cGraph); 



}else 

if ((simulEvent->eVertex->posrt.X < simulEvent->eVertex->next->posit.X) 
&&(simulEvent->eVertex->posit.X < simulEvent->eVertex->prev->posit.X)) 

{ 

r this is an minimal exterior convex vertex*/ 

if (simulEvent->eVertex->bndry(1]==’0’)/*only vertex*/ 
startCellUp(simulEvent, &cellList, 
activeEdges, &activeFences, cGraph); 
startCellDown(simulEvent, &cellList, 

activeEdges, AactiveFences, cGraph); 



}else{ 

/*this is a maximal exterior convex vertex*/ 
if (simulEvent->eVertex->bndry(1]==’0’)/*only vertex*/ 
startCellUpDown(simulEvent, ScellList, 
activeEdges, &activeFences, cGraph); 



} 

}else{/*concave vertex*/ 

if ((simulEvent->eVertex->posit.X < simulEvent->eVertex->next->posit.X) 
&&(simulEvent->eVertex->posit.X < simulEvent->eVertex->prev->posit.X)) 

{ 

r this is a minimal extreme concave vertex*/ 
startCelllsolated(simulEvent, &cellList, cGraph); 

}else 

if ((simulEvent->eVertex->posit.X >= simulEvent->eVertex->next->posit.X) 
&&(simulEvent->eVertex->posit.X < simulEvent->eVertex->prev->posit.X)) 

{ 

/* this is a maximal extreme concave vertex*/ 
if ((simulEvent->eVertex->bndry[1]==’0’) && (cellList)) 
extendCell(simulEvent, &cellList);/*only vertex*/ 



}else 

if ((simulEvent->eVertex->posit.X < simulEvent->eVertex->next->posit.X) 
&&(simulEvent->eVertex->posit.X == simulEvent->eVertex->prev->posit.X)) 
{ 

r this is an upper right corner */ 
startCellDown(simulEvent, &cellList, 

activeEdges, AactiveFences, cGraph); 

} 

} 

simulEvent = simulEvent->next; 

)while((simulEvent) && 

(currentEvent*>eVertex->posit.X == simulEvent->eVertex->posit.X)); 
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r DELETE EDGES LOOP / 

simulEvent = currentEvent; 
do{ 

deleteEdge(simul Event, &activeEdges); 
simulEvent = simulEvent->next; 



}while((simulEvent) && 

(currentEvent->eVertex->posit.X == simulEvent->eVertex->posit.X) && 
(activeEdges)): 
currentEvent = simulEvent; 



} 



/*The decomposition is complete, link up the last and first polygons*/ 
cellList=robotsWorld->polygonList; 

\while(cellList->next) 
cellList = cellList->next; 
cellList->next = robotsWorld->polygonList; 

return robotsWorld; 

} 



D. DECOMPOSE UTILITIES 
1. decomputil.h 



/ 

FILE: decomposutil.h 

PURPOSE: This file contains the prototypes for the functions which 
do the actual work for the decomposition. 
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#ifndef dcmputil_h 

#define dcmputil_h 

#include “build.h" 

typedef struct edge{ 
vertex* leadingVertex; 
vertex* trailingVertex; 
double xPoint; 
struct edge* next; 
}edge; 

typedef struct fence{ 
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vertex* topVertex; 
vertex* bottomVertex; 
polygon* owner; 
struct fence* next; 

}fence; 

vertex*)**** 

This function computes the y-coordinate of the intersection of the 
extension of the sweep line and the current edge. The x*coordinate is 
the same as the current event. 



double intersect(edge* , vertex*); 

r ********* addEdge(event*, edge**)***' 

This function adds edges to the active edge list 
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int addEdge(event*, edge**); 

^..........................^glgjg^jjgg^gygpj. edge**)*' 

This function deletes edges from the active edge list 
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int deleteEdge(event*, edge**); 
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r.........startCgllUp(gvgnt., polygon**, edge*, fence**, node*) 

This function finds the vertices for the start of an up cell 



* / 

void startCellUp(event*, polygon**, edge*, fence**, node**); 

/*.........startCgllDown(gvgnt., polygon*, edge*, fence**, node**) 

This function finds the vertices for the start of a down cell 



/ 

void startCellDown(event*, polygon**, edge*, fence**, node**); 

r........startCellUpDown(gvent., polygon*, edge*, fence*, node**) 

This function finds the vertices for the start of an up/down cell 
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void startCellUpDown(event*, polygon**, edge*, fence**, node**); 

/* ****startCelllsolated(event*, polygon**, node**) •**•***■ 

ADD ISOLATED CELL TO WORKING LIST 

*/ 



void startCelllsolated(event*, polygon**, node**); 

r finishCellUp(event*, polygon**, edge*, world**, fence**)********* 

This function locates which cell on the active list is completed by this 
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event, adds the apprpriate vertices, and adds new cell to the world 

***** * * / 

void finishCellUp(event*, polygon**, edge*, world**, fence**); 

/******finishCellDown(event*, polygon**, edge*, world**, fence**, int) * 

This function locates which cell on the active list is completed by this 
event, adds the apprpriate vertices, and adds new cell to the world 

/ 

void finishCellDown(event*, polygon**, edge*, world**, fence**, int); 

/*****finishCellUpDown(event*, polygon**, edge*, world**, fence*)******* 
This function locates which cell on the active list is completed by this 
event, adds the apprpriate vertices, and adds new cell to the world 

**** / 

void finishCellUpDown(event*, polygon**, edge*, world**, fence**); 

/*****finishCelllsolated(event*, polygon**, world**) 

This function locates which cell on the active list is completed by this 
event, adds the apprpriate vertices, and adds new cell to the world 

/ 

void finishCelllsolated(event*, polygon**, world**); 

/*************extendCell(event* polygon**)***************************** 

This function locates which cell on the active list needs to be 
extended by this concave vertex 



void extendCell(event*, polygon**); 
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/******putFence(fence**, polygon*, vertex*, vertex*)****************** 
This function puts an adjacency fence on a list to be matched later 



void putFence(fence**, polygon*, vertex*, vertex*); 
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r updateAdj(fence**, polygon*, vertex*, vertex*, node**) 

This function matches an adjacency fence with one already on the list 
to determine cell adjacency, and then updates the adjacency graph 



void updateAdj(fence**,polygon*, vertex*, vertex*, node**); 
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This function adds a node to the connectivity graph whenever a cell 
is created 



7 
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void addNode(node**, polygon*); 
#endif 



2. decomputil.c 

r 

FILE: decomposutil.c 

PURPOSE: This file contains the functions which do the actual work 
for the decomposition. 
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#include <stdlib.h> 

#include <stdio.h> 

#include “build. h” 

#include “decomputil.h” 

#include “util.h" 

edge**)**** 

This function adds edges to the active edge list 



* / 

int 

addEdgefevent* currentEvent, edge** activeEdges){ 

edge* currentEdge; 
edge* previousEdge; 
int edgesAdded = 0; 

double delta = 1e-20;/*small number close to zero*/ 

currentEdge = (*activeEdges); 
previousEdge= (*activeEdges); 

while((currentEdge) && 

((currentEdge->xPoint = intersect(currentEdge, currentEvent->eVertex)) 

> (currentEvent->eVertex->posit.Y+delta))) { 
previousEdge = currentEdge; 
currentEdge = currentEdge->next; 

} 

/*identify convex and concave vertices, and simultaneous vertices now too*/ 
if (order((currentEvent->eVertex->prev->posit), 

(currentEvent->eVertex->posit), 

(currentEvent->eVertex*>next*>posit)) > 0.0){ 
currentEvent*>eVertex->bndry[0]=’V’; 

if((currentEvent*>eVertex->posit.X > currentEvent->eVertex->prev->posit.X)&& 
(currentEvent->eVertex->posit.X < currentEvent->eVertex->next*>posit.X)) 
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currentEvent->eVertex->bndry[1]=’0’; 
else if ((previousEdge)&& 

((previousEdge->leadingVertex->posit.X == currentEvent->eVertex->posit.X)ll 
(previousEdge->trailingVertex->posit.X == currentEvent->eVertex->posit.X))) 
currentEvent->eVertex->bndry[1]=’N’; 
else 

currentEvent->eVertex->bndry[1]=’0’: 

}else{ 

currentEvent->eVertex->bndry[0]=’C’; 

if(((currentEvent->eVertex->posit.X >= currentEvent->eVertex->prev->posit.X)&& 
(currentEvent->eVertex->posit.X <= currentEvent->eVertex->next->posit.X)) II 
((currentEvent->eVertex->posit.X > currentEvent->eVertex->prev->posit.X)&& 
(currentEvent->eVertex->posit.X > currentEvent->eVertex->next->posit.X)) II 
((currentEvent->eVertex->posit.X < currentEvent->eVertex->prev->posit.X)&& 
(currentEvent->eVertex->posit.X < currentEvent->eVertex->next->posit.X))) 
currentEvent->eVertex->bndry(1]=’0’; 
else if ((previousEdge)&& 

((previousEdge->leadingVertex->posit.X == currentEvent->eVertex->posit.X)ll 
(previousEdge->trailingVertex->posit.X == currentEvent->eVertex->posit.X))) 
currentEvent->eVertex->bndry[1]=’N’; 
else 

currentEvent->eVertex->bndry(1]=’0’: 



Tmaximal vertex; no edges added*/ 

if ((currentEvent->eVertex->posit.X > currentEvent->eVertex->next->posit.X) && 
(currentEvent->eVertex->posit.X > currentEvent->eVertex->prev->posit.X)){ 

return edgesAdded; 

} 

/*examine edge defined by next vertex*/ 

if (currentEvent->eVertex->posit.X < currentEvent->eVertex->next->posit.X){ 
if (currentEdge == (*activeEdges)){ 
currentEdge = (edge*)malloc(si 2 eof(edge)); 
currentEdge->next = (‘activeEdges); 

(*activeEdges) = currentEdge; 

}else{ 

currentEdge=(edge*)malloc(si 2 eof(edge)); 
currentEdge*>next = previousEdge->next; 
previousEdge->next = currentEdge; 

} 

currentEdge->leadingVertex = currentEvent->eVertex; 
currentEdge*>trailingVertex = currentEvent->eVertex->next; 
currentEdge->xPoint = currentEvent->eVertex->posit.Y; 
edgesAdded++; 

} 

/•examine edge defined by previouss vertex*/ 

if (currentEvent->eVertex->posit.X < currentEvent*>eVertex->prev->posit.X){ 
if (edgesAdded && currentEvent->eVertex->prev->posit.Y < 
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currentEvent->eVertex->next->posit.Y){ 
previousEdge = currentEdge; 
currentEdge = currentEdge->next; 

} 

if (currentEdge == (*activeEdges)){ 
currentEdge = (edge*)malloc(sizeof(edge)); 
currentEdge->next = (*activeEdges); 

('activeEdges) = currentEdge; 

}else{ 

currentEdge=(edge*)malloc(sizeof(edge)): 
currentEdge->next = previousEdge->next; 
previousEdge->next = currentEdge; 

} currentEdge->leadingVertex = currentEvent->e Vertex; 
currentEdge->trailingVertex = currentEvent->eVertex->prev; 
currentEdge->xPoint = currentEvent->eVertex->posit.Y; 
edgesAdded++; 

} 

return edgesAdded; 



} 

gdge**)*' 

This function deletes edges from the active edge list 



7 



int 

deleteEdge(event* currentEvent, edge** activeEdges){ 

edge* currentEdge; 
edge* previousEdge; 
int edgesDeleted = 0; 

currentEdge = (‘activeEdges); 
previousEdge = (‘activeEdges); 

while(currentEdge){ 

if (currentEvent->eVertex == currentEdge->trailingVertex){ 

if (currentEdge == (‘activeEdges)) 
(*activeEdges)=(*activeEdges)->next; 
else 

previousEdge->next = currentEdge->next; 

currentEdge->leadingVertex = NULL; 
currentEdge->trailingVertex = NULL; 
currentEdge->next = NULL; 
free(currentEdge); 
edgesDeleted++; 
if(*activeEdges) 
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currentEdge = previousEdge->next; 
else 

currentEdge = NULL; 

}else{ 

previousEdge=currentEdge; 

currentEdge=currentEdge->next; 

} 

} 

return edgesDeleted; 

} 

This function computes the y-coordinate of the intersection of the 
extension of the sweep line and the current edge. The x-coordinate is 
the same as the current event. 



* / 

double 

intersect(edge* currentEdge, vertex* currentEvertex){ 

return(((((currentEdge->trailingVertex->posit.Y)- 
(currentEdge->leadingVertex->posit.Y))* 
((currentEvertex->posit.X)-(currentEdge->leadingVertex->posit.X)))/ 
UcurrentEdge->trailingVertex->posit.X)-(currentEdge->leadingVertex->posit.X))) 
+ currentEdge->leadingVertex->posit.Y); 

} 

/*.........startCellUp(event., polygon**, edge*, fence**, node*)******** 

This function finds the vertices for the start of an up cell 



* * */ 

void 

startCellUp (event* cEvent, polygon** cellList, 

edge* activeEdges, fence** activeFences, node** cGraph){ 

edge* cEdge; 
polygon* currentCell; 
vertex* curVertex; 
vertex* cellVertex; 
extern int cellCount; 

++cellCount; 

/* put new cell on active list and make a node on the graph*/ 
currentCell=(*cellList); 

(*cellList)=(polygon*)malloc(sizeof(polygon)); 

(*cellList)->next = currentCell; 
currentCell=(*cellList); 
addNode(cGraph, currentCell): 
sprintf(currentCell->name,”C%d",cellCount); 
currentCell->mode = -1; 
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r add current event vertex to this new cell */ 
curVertex = cEvent->eVertex; 

cellVertex = currentCell->vertexList =(vertex*)malloc(sizeof(vertex)); 
cellVertex->posit.X = curVertex->posit.X; 
cellVertex->posit.Y = curVertex->posit.Y; 
sprintf(cellVertex->bndry,”\0”); 

r add another vertex V 

cellVertex->prev=(vertex*)malloc(sizeof(vertex)): 

currentCell->open2 =curVertex->prev;/*bottom open vertex of this cell*/ 

cellVertex->prev->next = cellVertex; 

cellVertex->prev->prev = NULL; 

cellVertex->prev->posit.X = curVertex->prev->posit.X; 

cellVertex->prev->posit.Y = curVertex->prev->posit.Y; 

sprintf(cellVertex->prev->bndry,”%s",cEvent->owner->name); 

rfind appropriate edge which intersects the sweep line*/ 

cEdge = activeEdges; 

while((cEdge->next->xPoint 

= intersect(cEdge->next, curVertex)) > curVertex->posit.Y) 
cEdge = cEdge->next; 

r add this intersection point as a cell vertex */ 
cellVertex->next=(vertex*)malloc(sizeof(vertex)); 
cellVertex->next->prev = cellVertex; 
cellVertex->next->posit.X = curVertex->posit.X; 
cellVertex->next->posit.Y = cEdge->xPoint; 
sprintf(cellVertex->next->bndry,”\0”); 

r this edge will also be a cell adjacency edge */ 

updateAdj(activeFences, currentCeli,cellVertex->next,cellVertex.cGraph); 

/* add another vertex */ 

cellVertex = cellVertex->next; 

cellVertex->next=(vertex*)malloc(sizeof(vertex)); 

currentCell->open1 = cEdge->trailingVertex;/*top open vertex of this cell*/ 
cellVertex->next->prev = cellVertex; 
cellVertex->next->next = NULL; 

cellVertex->next->posit.X = cEdge->trairmgVertex->posit.X; 
cellVertex->next->posit.Y = cEdge->trailingVertex->posit.Y; 
sprintf(cellVertex->next->bndry,”%s”,cEvent->owner->name); 

} 

r startCellDown(event*, polygon*, edge*, fence**, node**)******* 

This function finds the vertices for the start of a down cell 



/ 

void 

startCellDown (event* cEvent, polygon** cellList, 

edge* activeEdges, fence** activePences, node** cGraph){ 
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edge* cEdge; 
polygon* currentCell; 
vertex* curVertex; 
vertex* nextVertex; 
vertex* cel I Vertex: 
extern int cellCount; 

++cellCount; 

/* put new cell on active list and make a node on the graph*/ 
currentCell=(*cellList): 

(*cel IList)=(polygon*)mal loc(sizeof (polygon)) ; 

(*cellList)->next = currentCell; 
currentCell=(*cellList); 
addNode(cGraph, currentCell); 
sprintf(currentCell->name,”C%d”, cellCount); 
currentCell->mode = -1; 

r add current event vertex to this cell */ 

curVertex = nextVertex = cEvent->eVertex; 

cellVertex = currentCell->vertexList=(vertex*)malloc(si 2 eof(vertex)): 

cellVertex->posit.X = curVertex->posit.X; 

cellVertex->posit.Y = curVertex->posit.Y; 

sprintf(cellVertex->bndry,”\0”); 

r add another vertex */ 

cellVertex->next=(vertex*)malloc(sizeof(vertex)); 

currentCell->open1 = curVertex->next;/*top open vertex for this cell*/ 

cellVertex->next->prev = cellVertex; 

cellVertex->next->next = NULL; 

cellVertex->next->posit.X = curVertex->next->posit.X; 

cellVertex->next->posit.Y = curVertex->next->posit.Y; 

sprintf{cellVertex->next->bndry,”%s”,cEvent->owner->name); 

do{/* do this for all simultaneous vertices below the current one */ 
curVertex = nextVertex; 
cEvent = cEvent->next; 
nextVertex = cEvent->eVertex; 

/* find appropriate edge which intersects the sweep line */ 
cEdge = activeEdges; 

while((cEdge->xPoint = intersect(cEdge, curVertex)) >= curVertex->posit.Y) 
cEdge = cEdge->next; 

r add this intersection point as a cell vertex */ 
cellVertex->prev=(vertex*)malloc(sizeof(vertex)): 
cellVertex->prev->next = cellVertex; 
cellVertex->prev->posit.X = curVertex->posit.X; 
cellVertex->prev->posit.Y = cEdge->xPoint; 
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/* will edge be an adjacency edge? */ 
if((curVertex->prev == nextVertex)&& 

(cellVertex->prev->posit.X == nextVertex->posit.X)) 
sprintf(cell\/ertex->prev->bndry,"%s”,cEvent->owner->name); 
else{ 

sprintf(cellVertex->prev->bndry,AO’’); 
updateAdj(activeFences, currentCell, 
cellVertex,cellVertex->prev,cGraph); 

} 

cellVertex = cellVertex->prev; 

}while (cEdge->trailingVertex->posit.X == curVertex->posit.X); 
r add another vertex */ 

currentCell->open2 = cEdge->trailingVertex;/*bot1om open vertex of cell*/ 
cellVertex->prev=(vertex*)malloc(sizeof(vertex)); 
cellVertex->prev->next = cellVertex; 
cellVertex->prev->prev = NULL; 

cellVerlex->prev->posit.X = cEdge->trailingVertex->posit.X; 
cellVertex->prev->posit.Y = cEdge->trailingVertex->posit.Y; 
sprintf(cellVertex->prev->bndry,”%s",cEvent->owner->name); 

} 

r startCellUpDown(event*, polygon*, edge*, fence*, node**)******** 

This function finds the vertices for the start of an up/down cell 



*/ 

void 

startCellUpDown (event* cEvent, polygon** cellList, 

edge* activeEdges, fence** activeFences, node** cGraph){ 

edge* cEdge; 
polygon* currentCell; 
vertex* curVertex; 
vertex* nextVertex; 
vertex* cellVertex; 
extern int cellCount; 

++cellCount; 

Tput new cell on active list and make a node on the graph*/ 
currentCell=(*cellList); 

(*cellList)=(polygon*)malloc(sizeof(polygon)); 

(*cellList)->next = currentCell; 
currentCell=(*cellList); 
addNode(cGraph, currentCell); 
currentCell->mode = -1; 
sprintf(currentCell->name,”C%d", cellCount); 

r add current event vertex to this cell */ 
curVertex = cEvent->eVertex; 

cellVertex = currentCell->vertexList = (vertex*)malloc(sizeof(vertex)); 
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cellVertex->posit.X = curVertex->posit.X; 
cellVertex->posit.Y = curVertex->posit.Y; 
sprintf(cellVertex->bndry,”\0”); 

/* find appropriate edge which intersects the sweep line */ 
cEdge = activeEdges; while((cEdge->next*>xPoint 

=intersect(cEdge*>next,curVertex)) > curVertex->posit.Y) 
cEdge = cEdge->next; 

r add this intersection point as a cell vertex */ 
cellVertex->next=(vertex*)malloc(sizeof(vertex)): 
cellVertex->next->prev = cellVertex; 
cellVertex*>next->posit.X = curVertex->posit.X; 
cellVertex->next*>posit.Y = cEdge->xPoint; 
sprintf(cellVertex->next->bndry,”\0”); 

r this edge will also be a cell adjacency edge */ 

updateAdj(activeFences, currentCell,cellVertex->next, cellVertex, cGraph); 

r add another vertex */ 

cellVertex = cellVertex->next; 

cellVertex->next=(vertex*)malloc(si 2 eof(vertex)); 

currentCell->open1 = cEdge->trailingVertex;/*top open vertex for cell*/ 

cellVertex*>next*>prev = cellVertex; 

cellVertex->next->next = NULL; 

cellVertex->next->posit.X = cEdge->trailingVertex->posit.X; 
cellVertex->next->posit.Y = cEdge->trailingVertex->posit.Y; 
sprintf(cellVertex->next->bndry,”%s",cEvent->owner->narhe); 

curVertex= nextVertex = cEvent->eVertex; 
cellVertex = currentCell->vertexList; 
do{/* do this for all simultaneous vertices */ 
curVertex = nextVertex; 
cEvent = cEvent->next; 
nextVertex = cEvent->eVertex; 

/* find appropriate edge which intersects the sweep line */ 
cEdge = activeEdges; 

while((cEdge*>xPoint = intersect(cEdge, curVertex)) >= curVertex->posit.Y) 
cEdge = cEdge->next; 

/* add this intersection point as a cell vertex */ 
cellVertex->prev=(vertex*)malloc(sizeof(vertex)); 
cellVertex->prev->next = cellVertex; 
cellVertex->prev->posit.X = curVertex->posit.X; 
cellVertex->prev->posit.Y = cEdge->xPoint; 

r will edge be an adjacency edge too? */ 
if(curVertex->prev == nextVertex) 
sprintf(cellVertex->prev->bndry,"%s’’,cEvent->owner->name); 
else{ 
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sprintf(cellVertex->prev->bndry,”\0”): 
updateAdj(activeFences, currentCell, 
cellVertex,cell\/ertex->prev,cGraph): 

} 

cellVertex = cell\/ertex*>prev; 

}while (cEdge->trailingVertex->posit.X == curVertex->posit.X); 

/*add another vertex */ 

cellVertex->prev={vertex*)malloc(sizeof(vertex)); 

currentCell->open2 = cEdge->trailingVertex;rbottom open vertex of cell*/ 
cellVertex->prev->next = cellVertex; 
cellVertex->prev*>prev = NULL; 

cellVertex->prev->posit.X = cEdge->trailingVertex->posit.X; 
cellVertex->prev->posit.Y = cEdge->trailingVertex->posit.Y; 
sprintf(cellVertex->prev->bndry,”%s”,cEvent->owner->name); 



} 



/****** startCelllsolated(event*, polygon**, node**) 

ADD ISOLATED CELL TO WORKING LIST 



/ 

void 

startCelllsolated (event* cEvent, polygon** cellList, node** cGraph){ 



polygon* currentCell; 
edge* cEdge; 
vertex* curVertex; 
vertex* nextVertex; 
vertex* cellVertex; 
extern int cellCount; 



++cellCount; 



/* add new cell to active list */ 
currentCell=(*cellList); 

(*cellList)=(polygon*)malloc(sizeof(polygon)); 

(*cellList)->next = currentCell; 
currentCell=(*cellList); 
addNode(cGraph, currentCell); 
currentCell->mode = -1; 
sprintf(currentCell->name,”C%d", cellCount); 

r add current event vertex to this cell */ 
curVertex = cEvent->eVertex; 

cellVertex = currentCell->vertexList = {vertex*)malloc(sizeof(vertex)); 
cellVertex->posit.X = curVertex->posit.X; 
cellVertex*>posit.Y = curVertex->posit.Y; 
sprintf(cellVertex->bndry,"%s”,cEvent->owner->name); 

/* add another vertex */ 

cellVertex->next=(vertex*)malloc(sizeof(vertex)); 
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currentCell->open1 = curVertex->next;/*top open vertex of cell*/ 
cellVertex->next->prev = cellVertex; 
cellVertex->next->next = NULL; 
cellVertex->next->posit.X = curVertex->next->posit.X; 
cellVertex ->next->posit.Y = curVertex->next->posit.Y; 
sprintf(cellVertex->next->bndry,"\0”); 

r add another vertex */ 

cellVertex->prev=(vertex*)malloc(sizeof(vertex)); 

currentCell->open2 = curVertex->prev;rbottom open vertex of cell*/ 

cellVertex->prev->next = cellVertex; 

cellVertex->prev->prev = NULL; 

cellVertex*>prev->posit.X = curVertex->prev->posit.X; 

cellVertex->prev->posit.Y = curVertex->prev->posit.Y; 

sprintf(cellVertex->prev->bndry,”%s",cEvent->owner->name); 



} 

/******finishCellUp(event*, polygon**, edge*, world**, fence**) 

This function locates which cell on the active list is completed by this 
event, adds the apprpriate vertices, and adds new cell to the world 

/ 

void 

finishCellUp (event* cEvent, polygon** cellList, 

edge* activeEdges, world** decompWorld, fence** activeFences){ 

edge* cEdge; 
polygon* currentCell; 
polygon* prevCell; 
vertex* curVertex; 
vertex* cellPendVertex; 
vertex* cellNendVertex; 
fence* newpence; 

prevCell = currentCell = (*cellList); 
curVertex = cEvent->eVertex; 
cEdge = activeEdges; 
while((cEdge->next->xPoint 

=intersect(cEdge->next,curVertex)) > curVertex->posit.Y) 
cEdge = cEdge->next; 

r find cell on active list which is to be completed by this vertex*/ 
while (currentCell->open1 != cEdge->trailingVertex){ 
prevCell = currentCell; 
currentCell = currentCell*>next; 

} 

/* move a pointer to both open vertices */ 
cellPendVertex = cellNendVertex = currentCell->vertexList; 
while (cellPendVertex->prev) 
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cellPendVertex = cellPendVertex->prev; 

while (cellNendVertex->next) 
cellNendVertex = cellNendVertex->nex1; 

r link up open vertices */ 
cellNendVertex->next = cellPendVertex; 
cellNendVertex->nex1->prev = cellNendVertex; 
cellNendVertex->posit.Y = cEdge->xPoint; 
cellNendVertex->posit.X = curVertex->posit.X; 
sprintf(cellNendVertex->bndry,”\0"); 

r this edge is an adjacency edge */ 

putFence(activeFences, currentCell, cellNendVertex, cellPendVertex); 

r add completed cell to the world */ 
if (prevCell != currentCell) 
prevCell->next = currentCell->next; 
else 

(*cellList) = currentCell->next; 

currentCell->next = (*decompWorld)->polygonList; 
(*decompWorld)->polygonList = currentCell; 



} 

/......finishCellDown(event', polygon**, edge*, world**, fence**, int)*' 

This function locates which cell on the active list is completed by this 
event, adds the apprpriate vertices, and adds new cell to the world 



finishCellDown (event* cEvent, polygon** cellList, 

edge* activeEdges, world** decompWorld, fence** activeFences, 
int concave){ 

edge* cEdge; 
polygon* currentCell; 
polygon* prevCell; 
vertex* curVertex; 
vertex* nextVertex; 
vertex* cellPendVertex; 
vertex* cellNendVertex; 

prevCell = currentCell = (*cellList); 
curVertex = nextVertex = cEvent->eVertex; 

/* find cell on active list which isto be completed by this vertex*/ 
while (currentCell->open1 != curVertex){ 
prevCell = currentCell; 
currentCell = currentCell ->next; 
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} 



r move a pointer to both open vertices*/ 
cellPendVertex = cellNendVertex = currentCell->vertexList; 
while {cellNendVertex->next) 
cellNendVertex = cellNendVertex->next; 

while (cellPendVertex->prev) 
cellPendVertex = cellPendVertex->prev; 

do{r do this for all simultaneous events*/ 
curVertex = nextVertex; 
cEvent = cEvent->next; 
nextVertex = cEvent->eVertex; 

/* add simiultaneous event vertices to this cell */ 
cEdge = activeEdges; 

while((cEdge->xPoint = intersect(cEdge, curVertex)) >= curVertex->posit.Y) 
cEdge = cEdge->next; 

cellNendVertex->next=(vertex*)malloc(sizeof(vertex)); 
cellNendVertex->next->prev = cellNendVertex; 
cellNendVertex->next->posit.X = curVertex->posit.X; 
cellNendVertex->next->posit.Y = cEdge->xPoint; 

/* is this added edge an adjacency edge too? */ 
if((curVertex->next == nextVertex)&& 

(cellNendVertex->next->posit.X == nextVertex->posit.X)) 
sprintf{cellNendVertex->bndry,"%s",cEvent->owner*>name): 
else{ 

sprintf(cellNendVertex->next->bndry,”\0”); 

putFence(activeFences,currentCell, 

cellNendVertex, cellNendVertex->next); 

} 

cellNendVertex = cellNendVertex->next: 

}while ((concave && ((curVertex->posit.X == curVertex->next->posit.X)&& 
(curVertex->next->posit.X < curVertex->next->next->posit.X)))ll 
((cEdge->leadingVertex->posit.X == curVerlex->posit.X) && 
((nextVertex->posit.X <= nextVertex->prev->posit.X)&& 
(nextVertex->posit.X <= nextVertex->next->posit.X)))); 

/*link up open vertices */ 
cellNendVertex->next = cellPendVertex->next; 
cellPendVertex->next*>prev = cellNendVertex; 

r add completed cell to the world */ 
if (prevCell 1= currentCell) 
prevCell->next = currentCell->next; 
else 

(*cellList) = currentCell->next; 
currentCell->next = (*decompWorld)->polygonList; 
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(*decompWorld)->polygonList = currentCell; 



} 

/*****finishCellUpDown(event*, polygon**, edge*, world**, fence*)******* 
This function locates which cell on the active list is completed by this 
event, adds the apprpriate vertices, and adds new cell to the world 

***** ***** **** / 

void 

finishCellUpDown (event* cEvent, polygon** cellList, 

edge* activeEdges, world** decompWorld, fence** activeFences){ 

edge* topEdge; 
edge* bottomEdge; 
polygon* currentCell; 
polygon* prevCell; 
vertex* curVertex; 
vertex* nextVertex; 
vertex* cellPendVertex; 
vertex* cellNendVertex; 

prevCell = currentCell = (*cellList); 
curVertex = nextVertex = cEvent->eVertex; 
topEdge = bottomEdge = activeEdges; 

while((topEdge->next->xPoint 

=intersect(topEdge->next,curVertex)) > curVertex->posit.Y) 
topEdge = topEdge->next; 

/* find cel on active list which is to be completed by this vertex*/ 
while (currentCell->openl != topEdge->trailingVertex){ 
prevCell = currentCell; 
currentCell = currentCell ->next; 

} 

/* move a pointer to both open vertices */ 
cellPendVertex = cellNendVertex = currentCell->vertexList; 
while (cellNendVertex->next) 
cellNendVertex = cellNendVertex->next; 

while (cellPendVertex->prev) 

cellPendVertex = cellPendVertex->prev; 

r add another vertex */ 
cellNendVertex->next = malloc(sizeof(vertex)); 
cellNendVertex->next->prev = cellNendVertex; 
cellNendVertex->posit.X = curVertex->posit.X; 
cellNendVertex->posit.Y = topEdge->xPoint; 
sprintf(cellNendVertex->bndry,"\0"); 
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r update the top open vertex */ 
cellNendVertex->next->posit.X = curVertex->posit.X; 
cellNendVertex->next->posit.Y = curVertex->posit.Y; 
sprintf(cellNendVertex*>next*>bndry,”\0”); 

r this edge is an adjacency edge */ 

putFence(activeFences, currentCell, cellNendVertex, cellNendVertex*>next); 

do{/* do for all simultaneous vertices */ 
cellNendVertex = cellNendVertex->next; 
curVertex = nextVertex; 
cEvent = cEvent->next; 
nextVertex = cEvent->eVertex; 
bottomEdge = activeEdges; 
while((bottomEdge*>xPoint = 

intersect(bottomEdge, curVertex)) >= curVertex->posit.Y) 
bottomEdge = bottomEdge*>next; 
cellNendVertex->next=(vertex*)malloc(sizeof(vertex)); 
cellNendVertex->next->prev = cellNendVertex; 
cellNendVertex->next->posit.X = curVertex->posit.X; 
cellNendVertex->next->posit.Y = bottomEdge->xPoint; 

/* is this edge an adjacency edge too? 7 
if((curVertex->next == nextVertex)&& 

(cellNendVertex->posit.X == nextVertex->posit.X)) 
sprintf(cellNendVertex->next->bndry,”%s”,cEvent->owner->name); 
else{ 

sprintf(cellNendVertex->next->bndry,”\0"); 
putFence(activeFences, currentCell, 
cellNendVertex, cellNendVertex->next); 

} 

jwhile ((bottomEdge->leadingVertex->posit.X == curVertex->posit.X) && 
((nextVertex->posit.X <= nextVertex->prev->posit.X)&& 
(nextVertex->posit.X <= nextVertex->next*>posit.X))); 

r link up open vertices 7 

cellNendVertex->next->next = cellPendVertex->next; 
cellPendVertex->next->prev = cellNendVertex->next; 

r add completed cell to the world 7 
if (prevCell != currentCell) 
prevCell->next = currentCell->next; 
else 

(•cellList) = currentCell*>next; 
currentCell->next = (*decompWorld)*>polygonList; 
(*decompV\/orld)*>polygonList = currentCell; 



} 

/*****finishCelllsolated(event*, polygon**, world**)********** * 

This function locates which cell on the active list is completed by this 
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event, adds the apprpriate vertices, and adds new cell to the world 

/ 

void 

finishCelllsolated (event* cEvent, polygon** cellList,world** decompWorld){ 

polygon* currentCell; 
polygon* prevCell; 
vertex* curVertex; 
vertex* cellPendVertex; 
vertex* cellNendVertex; 

prevCell = currentCell = (*cellList); 
curVertex = cEvent->eVertex; 

/* find cell on active list to be completed by this event */ 
while((currentCell->open1 != curVertex) 

II (currentCell->open2 != curVertex)){ 
prevCell = currentCell; 
currentCell = currentCell->next; 

} 

r move a pointer to both open vertices */ 
cellPendVertex = cellNendVertex = currentCell->vertexList; 
while {cellPendVertex->prev) 

cellPendVertex = cellPendVertex->prev; 

while (cellNendVertex->next) 

cellNendVertex = cellNendVertex->next; 

r link up open vertices */ 

cellNendVertex->next = cellPendVertex->next; 

cellPendVertex->next->prev = cellNendVertex; 

sprintf(cellPendVertex->bndry,”%s”,cEvent->owner->name); 

sprintf(cellPendVertex->next->bndry,”%s”,cEvent->owner->name); 

cellPendVertex->next = cellPendVertex->prev = NULL; 

free(cellPendVertex); 

r add completed cell to the world */ 
if (prevCell != currentCell) 
prevCell->next = currentCell->next; 
else 

(*cellList) = currentCell->next; 

currentCell->next = (*decompWorld)->polygonList; 
(*decompWorld)->polygonList = currentCell; 



} 

/* **extendCell(event* polygon**) **** 

This function locates which cell on the active list needs to be 
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extended by this concave vertex 



* * * / 

void 

extendCell(event* cEvent, polygon**. cellList){ 

polygon* currentCell; 
vertex* cellVertex; 
vertex* curVertex; 

currentCell = (*cellList); 
curVertex = cEvent->eVertex; 

/* find the correct cell */ 

while ((currentCell->open1 != curVertex) 

&& (currentCell->open2 != curVertex)) 
currentCell = currentCell*>next; 
cellVertex = currentCell->vertexList; 

/* is this the top of a cell ?*/ 
if ((curVertex->posit.X >= curVertex->next->posit.X) 
&&(curVertex->posit.X < curVertex->prev->posit.X)){ 
while(cellVertex->prev) 

cellVertex = cellVertex->prev; 
cellVertex->prev = malloc(sizeof(vertex)); 
cellVertex->prev->prev = NULL; 
cellVertex->prev->next = cellVertex; 
cellVertex->prev->posit.X = curVertex->prev->posit.X; 
cellVertex->prev->posit.Y = curVertex->prev->posit.Y; 
currentCell->open2 = curVertex->prev; 
sp.nntf(cellVertex->bndry,"%s”,cEvent->owner->name): 
sprintf(cellVertex->prev->bndry,"7os",cEvent->owner->name); 
}else{r or the botom? */ 
while(cellVertex*>next) 
cellVertex = cellVertex->next; 
cellVertex->next = malloc(sizeof(vertex)); 
cellVertex->next->next = NULL; 
cellVertex->next->prev = cellVertex; 
cellVertex->next->posit.X = curVertex->next->posit.X; 
cellVertex->next->posit.Y = curVertex->next->posit.Y; 
currentCell->open1 = curVertex->next; 
sprintf(cellVertex->bndry,"7os",cEvent->owner->name); 
sprintf (cel IVertex->next->bndry,"7oS",cEvent->owner->name) ; } 



/******putFence(fence**, polygon*, vertex*, vertex*)****************** 
This function puts an adjacency fence on a list to be matched later 

* * / 

void 

putFence(fence** fenceList, polygon* cell. 
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vertex* topVertex, vertex* bottomVertex){ 
fence* newpence; 

newpence = (fence*)malloc(sizeof(fence)); 
newPence->owner = cell; 
newPence->topVertex = topVertex; 
newPence->bottomVertex = bottomVertex; 

newPence->next = (*fenceList); 

{'fenceList) = newpence; 



} 

/* updateAdj(fence**. polygon*, vertex*, vertex*, node**)*******' 

This function matches an aojacency fence with one already on the list 
to determine cell adjacency, and then updates the adjacency graph 

/ 

void 

updateAdj(fence** fenceList, polygon* curCell, 

vertex* topVertex, vertex* bottomVertex, node** cGraph){ 

fence* curPence; 
fence* prevPence; 
node* firstNode; 
node* secondNode; 
arc* cArc; 



r find the matching fence */ 
curPence = prevPence = (*fenceList); 
while((curPence->topVertex->posit.X != topVertex->posit.X)ll 
(curPence->topVertex->posit.Y != topVertex->posit.Y)ll 
(curPence->bottomVertex->posit.X != bottomVertex->posit.X)ll 
(curPence->bottomVertex->posit.Y != bottomVertex->posit.Y)){ 
prevPence = curPence; 
curPence = curPence ->next; 

} 

r deleted the matched fence from the list */ 
if(curPence == (*fenceList)) 

(*fenceList)=(*fenceList)->next; 

else 

prevPence->next = curPence->next; 

r find the appropriate nodes of the graph */ 
firstNode = (*cGraph); 
while(firstNode->cell != curCell) 
firstNode = firstNode->next; 
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secondNode = (’cGraph); 
while(secondNode->cell != curFence->owner) 
secondNode = secondNode->next; 

r add arcs to both nodes on the graph V 
cArc = (arc*)malloc(sizeof(arc)); 
cArc->next = firstNode->arcList; 
firstNode->arcList = cArc; 
cArc->Node = secondNode; 
cArc->visited = 0; 

sprintf{bottomVertex->bndry,’’%s",curFence->owner->name); 

cArc = {arc*)malloc(sizeof(arc)); 
cArc->next = secondNode->arcList; 
secondNode->arcList = cArc; 
cArc->Node = firstNode; 
cArc->visited = 0; 

sprintf(curFence->topVertex->bndry,”%s”,curCell->name); 

} 

/ addNode(node**, polygon**) 

This function adds a node to the connectivity graph whenever a cell 
is created 



* / 

void 

addNode(node** cGraph, polygon* curCell){ 

node* newNode; 

newNode = (*cGraph); 

(*cGraph) = (node*)nnalloc(sizeof(node)); 

(*cGraph)->next = newNode; 
newNode = (*cGraph); 
newNode->cell = curCell; 
newNode->arcList = NULL; 
newNode->predecessor = NULL; 
newNode->curArc = NULL; 



} 



E. MISCELANEOUS UTILITIES 

1. util.h 



^***«* ***************************************************** *********** 
FILE: util.h 

PURPOSE: This file contains some small utility functions used 

by other functions in this program 

**********************************************************************/ 
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#ifndef world_util_h 

#define world_util_h 

#include “build.h” 



r 

PURPOSE: returns 0.0 if the three points are colinear, < 0.0 if 
they are clockwise, and > 0.0 if they are counterclockwise 

/ 

double order(point, point, point); 

r 

PURPOSE: frees memory allocated during world decompostion 

* / 

void freeWorld(world**, world**, event**, node**); 



r 



PURPOSE: reads either the world name or poygon name from the inputfile 



/ 

void getName(FILE*, char*, int); 

#endif 



2. util.c 



r 

FILE: util.c 

PURPOSE: This file contains some small utility functions used 
by other functions in this program 
/ 



#include <stdio.h> 

#include <stdlib.h> 

#include <math.h> 

#include “util.h” 

/******* getName(FILE*, char*) 

This function reads the characters from the input file which correspond 
to a world name, or a polygon name 

* / 

void 

getName(FILE* input_file, char* name, int length) 

{ 

int counter! ; 
int counter2; 
char letter: 

char tempName(IOO); 
counter! =0; 
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while(1){ 

if ((letter = getc(input_file)) == ‘(‘) 
break; 

else if((letter > T) && (letter < ‘-’)){ 
tempName[counter1] = letter; 
counter1++: 

} 

} 

for (counter2=0;((counter2 < (length-1 ))&&(counter2 != counter1));counter2++) 
name[counter2]=tempName[counter2]; 
name[counter2)= ‘XO’; 

} 

................. point, point)*********************** 

This function computes whether the orientation of the points is colinear, 
clockwise, or counter-clockwise. If the points are colinear, the function 
returns 0. If the points are clockwise, the function returns a number < 0. 

If the points are counter-clockwise, the function returns a number > 0 

/ 

double 

order (point first, point second, point third) 

{ 

return ((((second.X - first.X)*(third.Y - first.Y)) 

-((third.X - first.X)*(second.Y - first. Y)))/2.0); 

} 

/***** *******freeWorld(world**, world**, event**, node**) 

Thie function frees the allocated memory for one decomposition before 
another decomposition is attempted 

/ 

void 

freeWorld(world** origWorld, world** decWorld, 
event** eventList, node** cGraph) 

{ 



polygon* curPolygon; 
polygon* nextPolygon; 
vertex* curVertex; 
vertex* nextVertex; 
node* curNode; 
node* nextNode; 
arc* curArc; 

curPolygon = (*origWorld)->polygonList; 
do{ 

curVertex = curPolygon->verlexList; 
curVertex->prev->next = NULL; 
do{ 

nextVertex =curVertex->next; 



78 



free(curVertex); 
curVertex = nextVertex; 

}while (curVertex); 

nexlPolygon = curPolygon->next; 
free(curPolygon); 
curPolygon = nextPolygon; 

}while(curPolygon != (*origWorld)->polygonList); 

if (*decWorld){ 

curPolygon = (*decWorld)->polygonList; 
do{ 

curVertex = curPolygon->vertexList; 
curVertex->prev->next = NULL; 
do{ 

nextVertex =curVertex->next; 
free(curVertex); 
curVertex = nextVertex; 

}while (curVertex); 

nextPolygon = curPolygon->next; 
free(curPolygon); 
curPolygon = nextPolygon; 

}while(curPolygon != (*decWorld)->polygonList); 



} 

if (*cGraph){ 
curNode = (*cGraph); 

do{ 

curArc = curNode->arcList; 
do{ 

curNode->arcList = curArc->next; 
free(curArc); 

curArc = curNode->arcList; 
}while(curArc); 
nextNode = curNode->next; 
free(curNode); 
curNode = nextNode; 
}while(curNode); 

} 



free((*origWorld)); 

free((*decWorld)); 

free((*eventList)); 
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free((*cGraph)); 
(*eventList) = NULL; 
(*cGraph) = NULL; 

} 



F. CREATE WORLD FILES 
1. worldfile.h 

r 

FILE: worldfile.h 

PURPOSE: This file contains a function prototype 

* * / 



#ifndef worldfile_h 

#define worldfile.h 

#include “build.h" 

r.......createWorldFile(world., node*, char*, double*, int*,char*)** 

This function makes the file which defines the cells and vertices of 
the world, and the nodes and arcs of the graph. It also makes two 
functions which intialize these values 

*** / 



void createWorldFile(world*, node*, char*, double, int, char*); 
#endif 



2. worldfile.c 

r * * * * 

FILE: worldfile.c 

PURPOSE: This file contains the function which creates the C files 
that are used to link the world representation into yamabico’s 
kernel. 
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#include <stdio.h> 
#include <stdlib.h> 
#include <string.h> 
#include <math.h> 
#include “build.h” 
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r*******createWorldFile(world*. node*, char*, double*, int*,char*)******* 
This function makes the file which defines the cells and vertices of 
the world, and the nodes and arcs of the graph. It also makes two 
functions which intialize these values 

/ 

void 

createWorldFile(world* robotWorld, node* cGraph, char* fileName, 
double sweepAngle,int worldNumber, char* worldTag){ 

FILE* worldCfile; 

polygon* curPolygon; 
vertex* curVertex; 
node* curNode; 
node* adjNode; 
arc* curArc; 

double cosRotInv; 
double sinRotInv; 
double rotX, rotY; 

int counterl =1; 
int counter2 =1; 
int counters =1 ; 

cosRotInv = cos((-(M_Pr(90.0-sweepAngle)))/180.0): 

SinRotInv = sin((-{M_Pr(90.0-sweepAngle)))/180.0); 
worldCfile = fopen(fileName,”w"); 

fprintf(worldCfile,"/* This file is generated from world information\n”); 
fprintf(worldCfile,” and must be compiled and linked into Yamabico’s\n”); 
fprintf(worldCfile," kernel. The file Worlds. h\” contains the \n”); 
fprintf(worldCfile,” declarations which allow access to the \n”); 
fprintf(worldCfile," world model *An\n”); 
fprintf(worldCfile,"#include <stdlib.h>\n”); 
fprintf(worldCfile,"#include <stdio.h>\n”); 
fprintf(worldCfile,"#include <string.h>\n"); 
fprintf(worldCfile,"#include\”build.h\”\n\n”); 
fprintf(worldCfile,Tdeclaring structure for world*An\n"); 
fprintf(worldCfile,”world robotsWorld_%s;\n\n",worldTag); 
fprintf(worldCfile,Tdelcaring structures for polygons and vertices*An”); 
counterl = 1; 

curPolygon = robotWorld->polygonList; 
do{ 

fprintf(worldCfile,”\npolygon poly%d_%d;\n”,worldNumber, counterl); 
counters = 1 ; 

curVertex = curPolygon->vertexList; 
do{ 

fprintf(worldCfile,”vertex vert%d_%d_%d;\n",worldNumber, 
counterl , counters); 
curVertex = curVertex->next; 
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++counter2; 

}while(curVertex != curPolygon->vertexList); 
curPolygon = curPolygon->next; 

++counter1 ; 

)while(curPolygon != robotWorld->polygonList); 

r variables for connectivity graph */ 
if (cGraph){ 

fprintf(worldCfile,’Vi\nrdeclaring first node for graph*An\n"); 
fprintf(worldCfile,"node* worldGraph_%s;\n\n”,worldTag): 
fprintf(worldCfile,”/*delcaring structures for nodes and arcs* An"); 
counterl = 1; 
curNode = cGraph; 
do{ 

fprintf(worldCfile,”\nnode n6de%d_%d;\n”,worldNumber, counterl); 
counters = 1 ; 

curArc = curNode->arcList; 
do{ 

fprintf(worldCfile,”arc arc%d_%d_%d;\n",worldNumber, 
counterl, counters); 
curArc = curArc->next; 

++counterS; 

}while(curArc); 
curNode = curNode->next; 

++counter1; 

}while(curNode); 

} 

/‘initialization function for world representation*/ 
fprintf(worldCfile,”\n/* assigning values for polygons and ver1ices*/\n”); 

fprintf(worldCfile,”\n\nlnitializeWorld_%s(){\n",worldTag); 
fprintf(worldCfile,"\n robotsWorld_%s.polygonList = &poly%d_1 ; \n”, 
worldTag, worldN umber); 
counterl = 1 ; 

curPolygon = robotWorld->polygonList; 
do{ 

fprintf(worldCfile,”\n strcpy(poly%d_%d.name, \”%s\");\n", 
worldNumber, counterl ,curPolygon->name); 
fprintf(worldCfile,” poly%d_%d.mode = %d;\n",wo rid Number, 
counterl ,curPolygon->mode); 

fprintf(worldCfile," poly%d_%d.vertexList = &vert%d_%d_1 ;\n", 
worldNumber,counter1, worldNumber,counter1); 
if(curPolygon->next != robotWorld->polygonList) 
fprintf(worldCfile,” poly%d_%d.next = &poly%d_%d;\n”, 
worldNumber,counter1,worldNumber,(counter1+1)); 

else 

fprintf(worldCfile," poly%d_%d.next = &poly%d_1 ;\n", 
worldNumber,counter1 ,worldNumber); 

counters = 1 ; 
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curVertex = curPolygon->vertexList; 
do{ 

rotX = ((curVertex->posit.X*cosRotlnv)-(curVertex->posit.Y*sinRotlnv)); 
rotY = ((curVertex->posit.X*sinRotlnv)+(curVertex->posit.Y*cosRotlnv)): 
fprintf(worldCfile," vert%d_%d_%d.posit.X = %6.5f;\n”, 
worldNumber,counter1,counter2,rotX); 
fprintf(worldCfile,” vert%d_%d_%d.posit.Y = %6.5f;\n”, 
worldNumber,counter1,counter2,rotY); 
fprintf(woridCfile," strcpy(vert%d_%d_%d.bndry,\"%s\");\n”, 
worldNumber,counter1,counter2,curVertex->bndry); 
if(curVertex->next != curPolygon*>vertexList) 
fprintf(worldCfile," vert%d_%d_%d.next = &vert%d_%d_%d;\n" 
.worldNumber.counterl ,counter2, 
worldNumber,counter1 ,(counter2+1 )); 

else 

fprintf(worldCfile vert%d_%d_%d.next = &vert%d_%d_1 ;\n’’ 
.worldNumber, counterl ,counter2, 
worldNumber.counterl ); 

if(curVertex != curPolygon->vertexList) 
fprintf(worldCfile,” ver1%d_%d_%d.prev = &vert%d_%d_%d;\n" 
.worldNumber.counterl .counter2. 
worldNumber.counterl .(counter2-1 )); 
curVertex = curVertex->next; 

++counter2; 

}whiIe(curVertex != curPolygon->vertexList); 
fprintf(worldCfile.” vert%d_%d_1 .prev = &vert%d_%d_%d;\n". 

worldNumber.counterl .worldNumber.counterl .(counter2-1 )); 
curPolygon = curPolygon->next; 

++counter1 ; 

}while(curPolygon != robotWorld->polygonList); 
fprintf(worldCfile."}\n”): 

rinitialization function for connectivity graph */ 
if (cGraph){ 

fprintf(worldCfile.”\nrassigning values for node and arcs'An"); 

fprintf(worldCfile.”\n\nlnitializeGraph_%s(){\n".worldTag); 
fprintf(worldCfile."\n worldGraph_%s = &node%d_1; \n", 
worldTag. worldNumber); counterl = 1; 
curNode = cGraph; 
do{ 

counter3=1 ; 

curPolygon = robotWorld*>polygonList; 
while(curPolygon != curNode->cell){ 
counter3++; 

curPolygon = curPolygon->next; 

} 

fprintf(worldCfile.” node%d_%d.cell = &poly%d_%d;\n", 
worldNumber.counterl . worldNumber.counterS); 
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fprintf(worldCfile," node%d_%d.arcList = &arc%d_%d_1 ;\n", 
worldNumber.counterl ,worldNumber,counter1 ); 
fprintf(worldCfile,” node%d_%d.predecessor = NULL;\n”, worldNumber.counterl ); 
fprintf(worldCfile," node%d_%d.curArc = NULL;\n", worldNumber.counterl); 
if(curNode->next) 

fprintf(worldCfile." node%d_7od.next = &node*/od_®/od;\n", 
worldNumber.counterl .worldNumber.(counter1+1)); 

else 

fprintf(worldCfile,” node%d_7od.next = NULL;\n", 
worldNumber.counterl ); 
counter2 = 1 ; curArc = curNode->arcList; 
do{ 

counters = 1 ; 

Twhich polygon number corresesponds to this cell?*/ 
adjNode = cGraph; 
while(curArc*>Node != adjNode){ 
counter3++; 

adjNode = ad|Node->next; 

} 

fprintf(worldCfile." arc7od_7od_7od.Node = &node7od_%d;\n", 
worldNumber.counterl .counters. worldNumber.counterS); 
fprintf(worldCfile," arc7od_7od_7od.visited = 0;\n”. 

worldNumber.counterl .counters); 
if(curArc->next) 

fprintf(worldCfile.” arc7od_%d_%d.next = &arc%d_%d_7od;\n”. 
worldNumber.counterl .counters. 
worldNumber.counterl ,(counterS+1 )); 

else 

fprintf(worldCfile." arc7od_7od_%d.next = NULL;\n". 
worldNumber.counterl .counters); 
curArc = curArc->next; 

++counterS; 

}while(curArc); 
curNode = curNode->next; 

++counter1; 

}while(curNode); 

fprintf(worldCfile."}\n"); 

} 

fclose(worldCfile); 

printf(“The world for the %3.Sf degree sweep is in the file: %s\n", 
sweepAngle. fileName); 

printf(“and has the varialble name of; robotsWorld_®/os\n",worldTag); 

} 



3. sample world file 

r This file is generated from world information 
and must be compiled and linked into Yamabico’s 
kernel. The file “worlds.h" contains the 
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declarations which allow access to the 
world model */ 

#include <stdlib.h> 

#include <stdio.h> 

#include <string.h> 

#include “build. h” 

rdeclaring structure for world*/ 

world robotsWorld_180_00; 

rdelcaring structures for polygons and vertices*/ 

polygon poly2_1 ; 
vertex vert2_1_1; 
vertex vert2_1_2; 
vertex vert2_1_3; 
vertex vert2_1_4; 
vertex vert2_1_5; 
vertex vert2_1_6; 

polygon poly2_2; 
vertex vert2_2_1; 
vertex vert2_2_2; 
vertex vert2_2_3; 
vertex vert2_2_4; 
vertex vert2_2_5; 
vertex vert2_2_6; 

polygon poly2_3; 
vertex vert2_3_1 ; 
vertex vert2_3_2; 
vertex vert2_3_3; 
vertex vert2_3_4; 

polygon poly2_4; 
vertex vert2_4_1 ; 
vertex vert2_4_2; 
vertex vert2_4_3; 
vertex vert2_4_4; 

polygon poly2_5; 
vertex vert2_5_1; 
vertex vert2_5_2; 
vertex vert2_5_3; 
vertex vert2_5_4; 

polygon poly2_6; 
vertex vert2_6_1 ; 
vertex vert2_6_2; 
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vertex 


vert2_6_3; 


vertex 


vert2_6_4; 


vertex 


vert2_6_5; 


vertex 


vert2_6_6; 


vertex 


vert2_6_7; 


polygon poly2_7; 


vertex 


vert2_7_1 ; 


vertex 


vert2_7_2; 


vertex 


vert2_7_3; 


vertex 


vert2_7_4; 


vertex 


vert2_7_5; 


vertex 


vert2_7_6; 


vertex 


vert2_7_7; 


vertex 


vert2_7_8; 


vertex 


vert2_7_9; 


vertex 


vert2_7_10; 


vertex 


vert2_7_11; 


polygon poly2_8; 


vertex 


vert2_8_1; 


vertex 


vert2_8_2: 


vertex 


vert2_8_3; 


vertex 


vert2_8_4; 


polygon poly2_9; 


vertex 


vert2_9_1 ; 


vertex 


vert2_9_2; 


vertex 


vert2_9_3; 


vertex 


vert2_9_4; 


polygon poly2_10; 


vertex 


vert2_10_1: 


vertex 


vert2_10_2; 


vertex 


vert2_10_3; 


vertex 


vert2_10_4; 


vertex 


vert2_10_5; 


vertex 


vert2_10_6; 


vertex 


vert2_10_7; 


polygon poly2_1 1 ; 


vertex 


vert2_11_1; 


vertex 


vert2_11_2; 


vertex 


vert2_11_3; 


vertex 


vert2_11_4; 


polygon 


1 poly2_12; 


vertex 


vert2_12_1; 


vertex 


vert2_12_2; 


vertex 


vert2_12_3; 


vertex 


vert2_12_4; 



polygon poly2_13; 
vertex vert2_13_1; 
vertex vert2_13_2; 
vertex vert2_13_3; 
vertex vert2_1 3_4; 
vertex vert2_13_5; 

polygon poly2_14; 
vertex vert2_14_1; 
vertex vert2_14_2; 
vertex vert2_14_3; 
vertex vert2_14_4; 
vertex vert2_14_5; 
vertex vert2_1 4_6; 

polygon poly2_15; 
vertex vert2_15_1; 
vertex vert2_1 5_2; 
vertex vert2_15_3; 
vertex vert2_1 5_4; 
vertex vert2_15_5; 

polygon poly2_16; 
vertex vert2_1 6_1 ; 
vertex vert2_16_2; 
vertex vert2_16_3; 
vertex vert2_16_4; 
vertex vert2_16_5; 

polygon poly2_17; 
vertex vert2_1 7_1 ; 
vertex vert2_17_2; 
vertex vert2_17_3; 
vertex vert2_17_4; 
vertex vert2_17_5; 
vertex vert2_17_6: 



rdeclaring first node for graph*/ 

node* worldGraph_180_00; 

Tdelcaring structures for nodes and arcs*/ 

node node2_1 ; 
arc arc2_1_1; 

node node2_2; 
arc arc2_2_1 ; 
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node 


node2_3; 


arc 


arc2_3_1; 


arc 


arc2_3_2; 


node 


node2_4; 


arc 


arc2_4_1 ; 


node 


node2_5; 


arc 


arc2_5_1 ; 


arc 


arc2_5_2; 


arc 


arc2_5_3; 


node 


node2_6; 


arc 


arc2_6_1 ; 


arc 


arc2_6_2; 


node 


node2_7; 


arc 


arc2_7_1 ; 


arc 


arc2_7_2; 


arc 


arc2_7_3; 


arc 


arc2_7_4; 


arc 


arc2_7_5: 


node 


node2_8; 


arc 


arc2_8_1 ; 


arc 


arc2_8_2; 


arc 


arc2_8_3; 


node 


node2_9; 


arc 


arc2_9_1; 


arc 


arc2_9_2; 


node 


node2_10; 


arc 


arc2_10_1; 


arc 


arc2_10_2; 


node 


node2_11; 


arc 


arc2_11_1; 


arc 


arc2_11_2; 


node 


node2_12; 


arc 


arc2_12_1; 


arc 


arc2_12_2; 


node 


node2_13; 


arc 


arc2_13_1; 


arc 


arc2_13_2; 


node 


node2_14; 


arc 


arc2_14_1; 



node node2_15; 
arc arc2_15_1; 

node node2_16; 
arc arc2_16_1; 

node node2_17; 
arc arc2_17_1; 

/•assigning values for polygons and vertices*/ 



lnitializeWorld_1 80_00(){ 

robotsWorld_180_00.polygonList = &poly2_1; 

strcpy(poly2_1.name, “Cl 7"); 
poly2_1 .mode = *1; 
poly2_1 .vertexList = &vert2_1_1 ; 
poly2_1 .next = &poly2_2; 
vert2_1_l.posit.X = 5.60000; 
vert2_1_1 .posit.Y = 3.80000; 
strcpy(vert2_1_1 .bndry,”"); 
vert2_1_1.next = &vert2_1_2; 
vert2_1_2.posit.X = 5.60000; 
vert2_1_2.posit.Y = 6.00000; 
strcpy(vert2_1_2. bndry, "hi”); 
vert2_1_2.next = &vert2_1_3; 
vert2_1_2.prev = &vert2_1_1; 
vert2_1_3.posit.X = 8.40000; 
vert2_1_3.posit.Y = 6.00000; 
strcpy(vert2_1_3.bndry,"hr); 
vert2_1_3.next = &vert2_1_4; 
vert2_1_3.prev = &vert2_1_2; 
vert2_1_4.posit.X = 8.40000; 
vert2_1_4.posit.Y = 3.80000; 
strcpy(vert2_1 _4.bndry,”hr); 
vert2_1_4.next = &vert2_1_5; 
vert2_1_4.prev = &vert2_1_3; 
vert2_1_5.posit.X = 7.40000; 
vert2_1_5.posit.Y = 3.80000; 
strcpy(vert2_1_5. bndry, "Cl 5”); 
vert2_1_5.next = &vert2_1_6; 
vert2_1_5.prev = &vert2_1_4; 
vert2_1_6.posit.X = 6.40000; 
vert2_1_6.posit.Y = 3.80000; 
strcpy (ve rt2_1 _6 .bnd ry ,"h 1”); 
vert2_1_6.nex1 = &vert2_1_1; 
vert2_1_6.prev = &vert2_1_5; 
vert2_1_1.prev = &vert2_1_6; 
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strcpy(poly2_2.name, “Cl 6"); 
poly2_2.mode = -1; 
poly2_2.vertexList = &vert2_2_1 ; 
poly2_2.next = &poly2_3; 
vert2_2_1 .posit.X = 0.00000; 
ver12_2_1.posit.Y = 3.80000; 
strcpy(vert2_2_1 .bndfy,""); 
vert2_2_1 .next = &vert2_2_2; 
vert2_2_2. posit.X = 0.00000; 
vert2_2_2.posit.Y = 6.00000; 
strcpy(verl2_2_2.bndry,"h1 "); 
vert2_2_2.next = &vert2_2_3; 
ver12_2_2.prev = &vet12_2_1 ; 
vert2_2_3.posit.X = 4.20000; 
vert2_2_3.posit.Y = 6.00000; 

strcpy(vert2_2_3.bndry,””)l 

vert2_2_3.next = &vert2_2_4; 
vert2_2_3.prev = &vert2_2_2; 
vert2_2_4.posit.X = 4.20000; 
vert2_2_4.posit.Y = 3.80000; 
strcpy(vert2_2_4.bndry,”hr); 
vert2_2_4.next = &vert2_2_5; 
vet12_2_4.prev = &vet12_2_3; 
vert2_2_5.posit.X = 2.00000; 
vert2_2_5.posit.Y = 3.80000; 
strcpy(vert2_2_5.bndry,"C12”); 
vert2_2_5.next = &vert2_2_6; 
ver12_2_5.prev = &vert2_2_4; 
vert2_2_6.posit.X = 1 .00000; 
vert2_2_6.posit.Y = 3.80000; 
strcpy(vert2_2_6.bndry,”hr); 
vert2_2_6.next = &verl2_2_1 ; 
vert2_2_6.prev = &vert2_2_5; 
vert2_2_1 .prev = &vert2_2_6; 

strcpy(poly2_3.name, “C14"); 
poly2_3.mode = -1; 
poly2_3.vertexList = &vert2_3_1 ; 
poly2_3.next = &poly2_4; 
vert2_3_1. posit.X = 4.40000; 
vert2_3_1.posit.Y = 3.60000; 
strcpy(vert2_3_1 .bndry,""); 
vert2_3_1 .next = &vert2_3_2; 
vert2_3_2. posit.X = 4.40000; 
vert2_3_2.posit.Y 4.20000; 
strcpy(verl2_3_2.bndry,"hr); 
vert2_3_2.next = &vert2_3_3; 
vert2_3_2.prev = &ver12_3_1 ; 
vert2_3_3.posit.X = 5.40000; 
vert2_3_3.posit.Y = 4.20000; 
strcpy(vert2_3_3.bndry,’”); 



vert2_3_3.next = &vert2_3_4; 
vert2_3_3.prev = &vert2_3_2: 
vert2_3_4.posit.X = 5.40000; 
vert2_3_4.posit.Y = 3.60000; 
strcpy(vert2_3_4.bndry,”Cl 3"); 
vert2_3_4.next = &vert2_3_1 ; 
vet12_3_4.prev = &vert2_3_3; 
vert2_3_1 .prev = &vert2_3_4; 

strcpy(poly2_4.name, “Cl 5”); 
poly2_4.mode = -1; 
poly2_4.vertexList = &vert2_4_1; 
poly2_4.next = &poly2_5; 
vert2_4_1 .posit.X = 6.40000; 
vert2_4_1 .posit. Y = 3.60000; 
strcpy(vert2_4_1 .bndry,"”); 
vert2_4_1 .next = &vert2_4_2; 
vert2_4_2. posit.X = 6.40000; 
vert2_4_2.posit.Y = 3.80000; 
strcpy(vert2_4_2. bndry, "Cl T); 
vert2_4_2.next = &vert2_4_3; 
vert2_4_2.prev = &vert2_4_1; 
vert2_4_3.posit.X = 7.40000; 
vert2_4_3.posit.Y = 3.80000; 
strcpy(vert2_4_3. bnd ry,””); 
vert2_4_3.next = &vert2_4_4; 
vert2_4_3.prev = &vert2_4_2; 
vert2_4_4.posit.X = 7.40000; 
vert2_4_4.posit.Y = 3.60000; 
strcpy(vert2_4_4.bndry,"Cl 3"); 
vert2_4_4.next = &vert2_4_1; 
vert2_4_4.prev = &vert2_4_3; 
vert2_4_1 .prev = &vert2_4_4; 

strcpy(poly2_5.name, “C12"); 
poly2_5.mode = -1; 
poly2_5.vertexList = &vert2_5_1; 
poly2_5.next = &poly2_6; 
vert2_5_1 .posit.X = 1 .00000; 
vert2_5_1 .posit.Y = 3.60000; 
strcpy(vert2_5_1 .bndry,"”); 
vert2_5_1 .next = &vert2_5_2; 
vert2_5_2.posit.X = 1 .00000; 
vert2_5_2.posit.Y = 3.80000; 
strcpy(vert2_5_2.bndry,"C1 6"); 
vert2_5_2.next = &vert2_5_3; 
verl2_5_2.prev = &vert2_5_1 ; 
vert2_5_3.posit.X = 2.00000; 
vert2_5_3.posit.Y = 3.80000; 
strcpy(vert2_5_3.bndry,"”); 
vert2_5_3.next = &vert2_5_4; 
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vert2_5_3.prev = &vert2_5_2; 
vert2_5_4.posit.X = 2.00000; 
vert2_5_4.posit.Y = 3.60000; 
strcpy(vert2_5_4.bndry,"Cl 1”); 
vert2_5_4.next = &vert2_5_1; 
vert2_5_4.prev = &vert2_5_3; 
vert2_5_1 .prev = &vert2_5_4; 



strcpy(poly2_6.name, “Cl 3”); 
poly2_6.mode = -1; 
poly2_6.vertexList = &vert2_6_1 ; 
poIy2_6.next = &poly2_7; 
vert2_6_1 .posit.X = 2.00000; 
vert2_6_1 .posit. Y = 3.60000; 
strcpy(vert2_6_1 .bndry,”"); 
vert2_6_1 .next = &vert2_6_2; 
vert2_6_2.posit.X = 4.40000; 
vert2_6_2.posit.Y = 3.60000; 
strcpy(vert2_6_2. bndry ,”C1 4”); 
vert2_6_2.next = &vert2_6_3; 
vert2_6_2.prev = &vert2_6_1; 
vert2_6_3. posit.X = 5.40000; 
vert2_6_3.posit.Y = 3.60000; 
strcpy(vert2_6_3.bndry ,”h1 ”); 
vert2_6_3.next = &vert2_6_4; 
vert2_6_3.prev = &vert2_6_2; 
vert2_6_4. posit.X = 6.40000; 
vert2_6_4.posit.Y = 3.60000; 
strcpy(vert2_6_4.bndry ,”C1 5"); 
vert2_6_4.next = &vert2_6_5; 
vert2_6_4.prev = &vert2_6_3; 
vert2_6_5. posit.X = 7.40000; 
vert2_6_5.posit.Y = 3.60000; 
strcpy(vert2_6_5.bndry,”h1 "); 
vert2_6_5.next = &vert2_6_6; 
vert2_6_5.prev = &vert2_6_4; 
vert2_6_6.posit.X = 9.60000; 
vert2_6_6.posit.Y = 3.60000; 
strcpy(vert2_6_6.bndry,”’); 
vert2_6_6.next = &vert2_6_7; 
vert2_6_6.prev = &vert2_6_5; 
vert2_6_7.posit.X = 9.60000; 
vert2_6_7.posit.Y = 3.60000; 
strcpy(veft2_6_7.bndry,”C11 "); 
vert2_6_7.next = &vert2_6_1 ; 
vert2_6_7.prev = &vert2_6_6; 
vert2_6_1 .prev = &vert2_6_7; 

strcpy(poly2_7.name, “Cl 1”); 
poly2_7.mode = -1; 
poly2_7.vertexList = &vert2_7_1 ; 



poly2_7.next = &poly2_8; 
vert2_7_1 .posit.X = 4.00000; 
vert2_7_1 .posit. Y = 2.50000; 
strcpy(vert2_7_1 .bndry,"C1 0"); 
vert2_7_1 .next = &vert2_7_2; 
vert2_7_2.posit.X = 0.00000; 
vert2_7_2.posit.Y = 2.50000; 
strcpy(vert2_7_2.bndry,”"); 
vert2_7_2.next = &vert2_7_3; 
vert2_7_2.prev = &vert2_7_1 ; 
vert2_7_3.posit.X = 0.00000; 
vert2_7_3.posit.Y = 3.60000; 
strcpy(ve rt2_7_3. bnd ry."h r); 
vert2_7_3.next = &vert2_7_4; 
vert2_7_3.prev = &vert2_7_2; 
vert2_7_4.posit.X = 1.00000; 
vert2_7_4.posit.Y = 3.60000; 
strcpy(ve rt2_7_4 . bnd ry ,”C 1 2”); 
vert2_7_4.next = &vert2_7_5; 
vert2_7_4.prev = &vert2_7_3; 
vert2_7_5.posit.X = 2.00000; 
vert2_7_5.posit.Y = 3.60000; 
strcpy(vert2_7_5.bndry,"C1 3”); 
vert2_7_5.next = &vert2_7_6; 
vert2_7_5.prev = &vert2_7_4; 
vert2_7_6.posit.X = 9.60000; 
vert2_7_6. posit. Y = 3.60000; 
Strcpy(vert2_7_6.bndry,""); 
vert2_7_6.next = &vert2_7_7; 
vert2_7_6.prev = &vert2_7_5; 
vert2_7_7.posit.X = 9.60000; 
vert2_7_7.posit.Y = 2.50000; 
strcpy(vert2_7_7.bndry,"h1 ”); 
vert2_7_7.next = &vert2_7_8; 
vert2_7_7.prev = &vert2_7_6; 
vert2_7_8.posit.X = 8.60000; 
vert2_7_8.posit.Y = 2.50000; 
strcpy(vert2_7_8.bndry,"C9"); 
vert2_7_8.next = &vert2_7_9; 
vert2_7_8.prev = &vert2_7_7; 
vert2_7_9.posit.X = 8.00000; 
vert2_7_9.posit.Y = 2.50000; 
strcpy(vert2_7_9.bndry,"hr); 
vert2_7_9.next = &vert2_7_10; 
vert2_7_9.prev = &vert2_7_8; 
vert2_7_10.posit.X = 7.40000; 
vert2_7_10.posit.Y = 2.50000; 
strcpy(vert2_7_1 0.bndry.”C8"); 
vert2_7_10.next = &vert2_7_1 1 
vert2_7_10.prev = &vert2_7_9; 
vert2_7_1 1 .posit.X = 6.80000; 



vert2_7_1 1 .posit. Y = 2.50000; 
strcpy(vert2_7_1 1 .bndry,”hr); 
vert2_7_1 1 .next = &vert2_7_1 ; 
vert2_7_1 1 .prev = &vert2_7_10 
vert2_7_1 .prev = &vert2_7_1 1 ; 

strcpy(poly2_8.name, “C9"); 
pol>^_8.mode = -1; 
poly2_8.vertexList = &vert2_8_1 ; 
poly2_8.next = &poly2_9; 
vert2_8_1 .posit.X = 8.60000; 
vert2_8_1 .posit.Y = 2.30000; 
strcpy(vert2_8_1 .bndry ,”C4”); 
vert2_8_1 .next = &vert2_8_2; 
vert2_8_2.posit.X = 8.00000; 
vert2_8_2.posit.Y = 2.30000; 
strcpy(vert2_8_2.bndry,""); 
vert2_8_2.next = &vert2_8_3; 
vert2_8_2.prev = &vert2_8_1 ; 
vert2_8_3.posit.X = 8.00000; 
vert2_8_3.posit.Y = 2.50000; 
strcpy(vert2_8_3.bndry,"Cl 1”); 
vert2_8_3.next = &vert2_8_4; 
vert2_8_3.prev = &vert2_8_2; 
vert2_8_4.posit.X = 8.60000; 
vert2_8_4.posit.Y = 2.50000; 
strcpy(vert2_8_4.bndry,"”); 
vert2_8_4.next = &vert2_8_1; 
vert2_8_4.prev - &vert2_8_3; 
vert2_8_1 .prev = &vert2_8_4; 

strcpy(poly2_9.name, “C8”); 
poly2_9.mode = -1 ; 
poly2_9.vertexList = &vert2_9_1 ; 
poly2_9.next = &poly2_10; 
vert2_9_1 .posit.X = 6.80000; 
vert2_9_1 .posit.Y = 2.30000; 
strcpy(vert2_9_1 .bndry,"”); 
vert2_9_1 .next = &vert2_9_2; 
vert2_9_2.posit.X = 6.80000; 
vert2_9_2.posit.Y = 2.50000; 
strcpy(vert2_9_2. bndry, ”C1 1”); 
vert2_9_2.next = &vert2_9_3; 
vert2_9_2.prev = &vert2_9_1 ; 
vert2_9_3.posit.X = 7.40000; 
ver12_9_3.posit.Y = 2.50000; 
strcpy(vert2_9_3.bndry,""); 
vert2_9_3.next = &vert2_9_4; 
vert2_9_3.prev = &vert2_9_2; 
ver12_9_4.posit.X = 7.40000; 
vert2_9_4.posit.Y = 2.30000; 



strcpy(vert2_9_4.bndry."C3"); 
vert2_9_4.next = &vert2_9_1 ; 
vert2_9_4.prev = &verl2_9_3; 
vert2_9_1 .prev = &vert2_9_4; 

slrcpy(poly2_10.name, “C10"); 
poly2_10.mode = -1; 
poly2_10.vertexList = &vert2_10_1; 
poly2_10.next = &poly2_11; 
vert2_10_1.posit.X = 0.00000; 
vert2_10_1. posit. Y = 2.50000; 
Strcpy(vert2_1 0_1 .bndry,”"); 
vert2_10_1.next = &vert2_10_2; 
vert2_10_2.posit.X = 0.00000; 
vert2_10_2.posit.Y = 2.50000; 
strcpy(vert2_10_2.bndry,”Cl 1"); 
vert2_10_2.next = &vert2_10_3; 
vert2_10_2.prev = &vert2_10_1; 
vert2_10_3.posit.X = 4.00000; 
vert2_10_3.posit.Y = 2.50000; 
strcpy(ve rt2_ 1 0_3. bndry ,”h 1 ”); 
vert2_10_3.next = &vert2_10_4; 
vei12_10_3.prev = &vert2_10_2; 
vert2_10_4.posit.X = 4.00000; 
vert2_10_4. posit. Y = 2.50000; 
strcpy(vert2_1 0_4.bndry,”C7’); 
vert2_10_4.next = &vert2_10_5; 
vert2_10_4.prev = &vert2_10_3; 
vert2_10_5.posit.X = 3.20000; 
vert2_10_5.posit.Y = 2.50000; 
strcpy(vert2_ 1 0_5. bnd ry ,”h 1 ”) ; 
vert2_10_5.next = &vert2_10_6; 
vert2_10_5.prev = &vert2_10_4; 
vert2_10_6.posit.X = 1.40000; 
vert2_10_6.posit.Y = 2.50000; 
strcpy(vert2_1 0_6.bndry,"C5”); 
vert2_10_6.next = &vert2_10_7; 
vert2_10_6.prev = &vert2_10_5; 
vert2_10_7.posit.X = 0.80000; 
vert2_10_7.posit.Y = 2.50000; 
strcpy(vert2_10_7.bndry,”hr); 
vert2_10_7.next = &vert2_10_1; 
vert2_10_7.prev = &vert2_10_6; 
vert2_10_1.prev = &vert2_10_7; 

strcpy(poly2_1 1 .name, “C7”); 
poly2_1 1 .mode = -1; 
poly2_11.vertexList = &vert2_11_1; 
poly2_1 1 .next = &poly2_1 2; 
vert2_11_1.posit.X = 4.00000; 
vert2_1 1_1 .posit.Y = 2.30000; 
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strcpy(vert2_1 1_1 .bndry,"C6”); 
vert2_1 1_1 .next = &vert2_1 1_2; 
vert2_11_2.posit.X = 3.20000; 
vert2_11_2.posit.Y = 2.30000; 
strcpy(vert2_1 1_2.bndry,’”); 
vert2_1 1_2.next = &vert2_1 1_3; 
vert2_1 1_2.prev = &vert2_1 1_1 ; 
vert2_1 1_3.posit.X = 3.20000; 
vert2_1 1_3.posit.Y = 2.50000; 
strcpy(vert2_1 1_3.bndry,”ClO”); 
vert2_1 1_3.next = &vet12_1 1_4; 
vert2_11_3.prev = &vert2_11_2; 
vert2_1 1_4.posit.X = 4.00000; 
vert2_11_4.posit.Y = 2.50000; 
strcpy(vert2_1 1_4.bndry,””); 
vert2_1 1_4.next = &vert2_11_1; 
vert2_1 1_4.prev = &vert2_1 1_3; 
vert2_11_1.prev = &vert2_11_4; 

strcpy(poly2_12.name, “C5"); 
poly2_12.mode = -1; 
poly2_12.vertexList = &vert2_12_1; 
poly2_12.next = &poly2_13; 
vert2_12_1 . posit. X = 0.80000; 
vert2_12_1 .posit. Y = 2.30000; 
strcpy(vert2_12_1 .bndry,””); 
vert2_12_1.next = &vert2_12_2; 
vert2_12_2.posit.X = 0.80000; 
vert2_12_2.posit.Y = 2.50000; 
strcpy(vert2_1 2_2.bndry,”Cl 0"); 
vert2_12_2.next = &vert2_12_3; 
vert2_12_2.prev = &vert2_12_1; 
vert2_12_3.posit.X = 1.40000; 
vert2_12_3. posit. Y = 2.50000; 
strcpy(vert2_1 2_3.bndry,””); 
vert2_12_3.next = &vert2_12_4; 
vert2_12_3.prev = &vert2_12_2; 
vert2_12_4.posit.X = 1.40000; 
ver12_12_4.posit.Y = 2.30000; 
strcpy(vert2_1 2_4.bndry,"Cl ”); 
vert2_12_4.next = &vert2_12_1; 
vert2_12_4.prev = &vert2_12_3; 
vert2_12_1.prev = &vert2_12_4; 

strcpy(poly2_13.name, “C4”); 
poly2_13.mode = -1; 
poly2_13.vertexList = &vert2_13_1; 
poly2_13.next = &poly2_14; 
vert2_13_1.posit.X = 8.00000; 
vert2_13_1 .posit. Y = 0.00000; 
strcpy(vert2_13_1 .bndry, ”h1”); 



vert2_l3_l.next = &vert2_13_2; 
vert2_13_2.posit.X = 8.00000; 
vert2_13_2.posit.Y = 2.30000; 
strcpy(verl2_1 3_2.bndry,"C9”); 
vert2_1 3_2.next = &vert2_13_3; 
vert2_13_2.prev = &vert2_13_1; 
vert2_13_3.posit.X = 8.60000; 
vert2_13_3.posit.Y = 2.30000; 
strcpy(vert2_1 3_3.bndry,"”); 
vert2_13_3.next = &vert2_13_4; 
vert2_13_3.prev = &vert2_13_2; 
vert2_13_4.posit.X = 9.60000; 
vert2_13_4.posit.Y = 2.30000; 
strcpy(vert2_1 3_4.bndry,”hr); 
vert2_13_4.next = &vert2_13_5; 
vert2_13_4.prev = &vert2_13_3; 
vert2_13_5.posit.X = 9.60000; 
vert2_13_5.posit.Y = 0.00000; 
strcpy(vert2_1 3_5.bndry,”hr); 
vert2_13_5.next = &vert2_13_1; 
vert2_1 3_5.prev = &vert2_13_4; 
vert2_13_1 .prev = &vert2_1 3_5; 

strcpy(poly2_14.name, “C3"); 

poly2_14.mode = -1; 

poly2_14.vertexLisl = &vert2_14_1; 

poly2_14.next = &poly2_15; 
vert2_14_1.posit.X = 5.00000; 
vert2_14_1. posit. Y = 0.00000; 
strcpy(vert2_14_1 .bndry,”hr); 
vert2_14_1.next = &vert2_14_2; 
vert2_14_2.posit.X = 5.00000; 
vert2_14_2.posit.Y = 2.30000; 
strcpy(vert2_14_2.bndry,"hr); 
vert2_14_2.next = &verl2_14_3; 
vert2_14_2.prev = &vert2_14_1; 
vert2_14_3.posit.X = 6.80000; 
vert2_14_3.posit.Y = 2.30000; 
strcpy(vert2_1 4_3.bndry,”C8”); 
vert2_14_3.next = &vert2_14_4; 
vert2_14_3.prev = &vert2_14_2; 
vert2_14_4.posit.X = 7.40000; 
vert2_14_4.posit.Y = 2.30000; 
strcpy(vert2_1 4_4.bndry "hi”); 
vert2_14_4.next = &vert2_14_5; 
vert2_14_4.prev = &vert2_14_3; 
vert2_14_5.posit.X = 7.80000; 
vert2_14_5.posit.Y = 2.30000; 
strcpy(vert2_1 4_5.bndry,”"); 
vert2_14_5.next = &vert2_14_6; 
verl2_14_5.prev = &vert2_14_4; 
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vert2_14_6posit.X = 7.80000; 
vert2_14_6.posit.Y = 0.00000; 
strcpy(vert2_14_6.bndry,"hr); 
vert2_14_6.next = &vert2_14_1; 
vert2_14_6prev = &vert2_14_5; 
vert2_1 4_1 .prev = &vert2_1 4_6; 

strcpy(poly2_1 S.name, “C6”); 
poly2_l5.mode = -1; 
poly2_15.vertexList = &vert2_15_1; 
poly2_1 S.next = &poly2_1 6; 
vert2_15_1.posit.X = 3.20000; 
vert2_15_1. posit. Y = 2.30000; 
strcpy(vert2_1 5_1 .bndry,”"); 
vert2_15_1.next = &vert2_15_2; 
vert2_15_2.posit.X = 3.20000; 
verl2_15_2.posil.Y = 2.30000; 
strcpy(vert2_1 5_2.bndry,"C7”); 
vert2_15_2.next = &vert2_15_3; 
vert2_1 5_2.prev = &vert2_1 5_1 ; 
vert2_15_3.posit.X = 4.00000; 
ver12_15_3.posit.Y = 2.30000; 
strcpy(vert2_1 5_3.bndry,"”); 
vert2_15_3.next = &vert2_15_4; 
vert2_1 5_3.prev = &vert2_1 5_2; 
vert2_15_4.posit.X = 4.80000; 
vert2_15_4.posit.Y = 2.30000; 
strcpy(vert2_1 5_4.bndry,"hr); 
vert2_1 5_4.next = &vert2_15_5; 
vert2_15_4.prev = &vert2_15_3; 
vert2_15_5.posit.X = 4.80000; 
vert2_15_5. posit. Y = 2.30000; 
strcpy(vert2_1 5_5.bndry,”C2"); 
vert2_15_5.next = &vert2_15_1; 
vert2_15_5.prev = &vert2_15_4; 
vert2_1 5_1 .prev = &vert2_1 5_5; 

strcpy(poly2_16.name, “C2”); 
poly2_16.mode = -1; 
poly2_1 S.vertexList = &vert2_16_1; 
poly2_16.next = &poly2_17; 
vert2_16_1 .posit.X = 2.40000; 
vert2_16_1. posit. Y = 0.00000; 
strcpy(vert2_16_1 .bndry ."hi"); 
vert2_1 6_1 .next = &vert2_16_2; 
vert2_16_2.posit.X = 2.40000; 
vert2_16_2.posit.Y = 2.30000; 
strcpy(vert2_1 6_2.bndry,"hr); 
vert2_16_2.next = &vert2_16_3; 
vert2_16_2.prev = &vert2_16_1 ; 
vert2_16_3.posit.X = 3.20000; 



vert2_16_3.posit.Y = 2.30000; 
strcpy(vert2_ 1 6_3.bndry,”C6”); 
vert2_16_3.next = &vert2_16_4; 
vert2_16_3.prev = &vert2_16_2; 
vert2_16_4.posit.X = 4.80000; 
vert2_16_4.posit.Y = 2.30000; 
strcpy(vert2_1 6_4.bndry,”"); 
vert2_16_4.next = &vert2_16_5; 
vert2_16_4.prev= &vert2_16_3; 
verl2_16_5.posit.X = 4.80000; 
vert2_16_5.posit.Y = 0.00000; 
strcpy(vert2_16_5.bndry,”hr); 
vert2_16_5.next = &vert2_16_1; 
vert2_16_5.prev = &vert2_16_4; 
vert2_16_1.prev = &vert2_16_5; 

strcpy(poly2_17.name, “C1”); 

poly2_17.mode = -1; 

poly2_17.vertexList = &vert2_17_1; 

poly2_17.next = &poly2_l; 
vert2_17_1.posit.X = 0.00000; 
verl2_17_1.posit.Y = 0.00000; 
strcpy(vert2_ 1 7_ 1 .bndry,”h 1 ”); 
vert2_17_1.next = &vert2_17_2; 
vert2_17_2.posit.X = 0.00000; 
vert2_17_2. posit. Y = 2.30000; 
strcpy(vert2_1 7_2.bndry,”h 1 ”); 
vert2_17_2.next = &vert2_17_3; 
vert2_17_2.prev = &vert2_17_1; 
vert2_17_3.posit.X = 0.80000; 
vert2_17_3.posit.Y = 2.30000; 
strcpy(vert2_1 7_3.bndry,”C5”); 
vert2_17_3.next = &vert2_17_4; 
vert2_17_3.prev = &vert2_17_2; 
vert2_17_4.posit.X = 1.40000; 
vert2_17_4.posit.Y = 2.30000; 
strcpy(vert2_1 7_4.bndry,”hr); 
vert2_17_4.next = &vert2_17_5; 
vert2_17_4.prev = &vert2_17_3; 
vert2_17_5.posit.X = 2.20000; 
vert2_17_5.posit.Y = 2.30000; 
strcpy(vert2_1 7_5.bndry,""); 
vert2_17_5.next = &vert2_17_6; 
vert2_17_5.prev = &vert2_17_4; 
vert2_17_6.posit.X = 2.20000; 
vert2_17_6.posit.Y = 0.00000; 
strcpy(vert2_17_6.bndry,”hr); 
vert2_17_6.next = &vert2_17_1; 
vert2_17_6.prev = &vert2_17_5; 
vert2_17_1 .prev = &vert2_17_6; 
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/•assigning values for node and arcs*/ 



lnitializeGraph_1 80_00(){ 

woridGraph_180_00 = &node2_1; 
node2_1 .cell = &poly2_1 ; 
node2_1 .arcList = &arc2_1_1; 
node2_1 .predecessor = NULL; 
node2_1 .curArc = NULL; 
node2_1.next = &node2_2; 
arc2_1_1.Node = &node2_3; 
arc2_1_1 .visited = 0; 
arc2_1_1.next = NULL; 
node2_2.cell = &poly2_2; 
node2_2.arcList = &arc2_2_1 ; 
node2_2.predecessor = NULL; 
node2_2.curArc = NULL; 
node2_2.next = &node2_3; 
arc2_2_1.Node = &node2_6; 
arc2_2_1 .visited = 0; 
arc2_2_1.next = NULL; 
node2_3.cell = &poly2_4; 
node2_3.arcList = &arc2_3_1 ; 
node2_3.predecessor = NULL; 
node2_3.curArc = NULL; 
node2_3.next = &node2_4; 
arc2_3_1 .Node = &node2_1; 
arc2_3_1 .visited = 0; 
arc2_3_1 .next = &arc2_3_2; 
arc2_3_2.Node = &node2_5; 
arc2_3_2.visited = 0; 
arc2_3_2.next = NULL; 
node2_4.cell = &poly2_3; 
node2_4. arcList = &arc2_4_1; 
node2_4.predecessor = NULL; 
node2_4.curArc = NULL; 
node2_4.next = &node2_5; 
arc2_4_1.Node = &node2_5; 
arc2_4_1 .visited = 0; 
arc2_4_1.next = NULL; 
node2_5.cell = &poly2_6; 
node2_5.arcList = &arc2_5_1 ; 
node2_5.predecessor = NULL; 
node2_5.curArc = NULL; 
node2_5.next = &node2_6; 
arc2_5_1 .Node = &node2_3; 
arc2_5_1 .visited = 0; 
arc2_5_1 .next = &arc2_5_2; 
arc2_5_2.Node = &node2_4; 
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arc2_5_2.visited = 0; 
arc2_5_2.next = &arc2_5_3; 
arc2_5_3.Node = &node2_7; 
arc2_5_3.visited = 0; 
arc2_5_3.next = NULL; 
node2_6.cell = &poly2_5; 
node2_6.arcList = &arc2_6_1 ; 
node2_6. predecessor = NULL; 
node2_6.curArc = NULL; 
node2_6.next = &node2_7; 
arc2_6_1 .Node = &node2_2; 
arc2_6_1 .visited = 0; 
arc2_6_1.next = &arc2_6_2; 
arc2_6_2.Node = &node2_7; 
arc2_6_2.visited = 0; 
arc2_6_2.next = NULL; 
node2_7.cell = &poly2_7; 
node2_7.arcList = &arc2_7_1; 
node2_7.predecessor = NULL; 
node2_7.curArc = NULL; 
node2_7.next = &node2_8; 
arc2_7_1.Node = &node2_5; 
arc2_7_1 .visited = 0; 
arc2_7_1 .next = &arc2_7_2; 
arc2_7_2.Node = &node2_6; 
arc2_7_2.visited = 0; 
arc2_7_2.next = &arc2_7_3; 
arc2_7_3.Node = &node2_9; 
arc2_7_3.visited = 0; 
arc2_7_3.next = &arc2_7_4; 
arc2_7_4.Node = &node2_10; 
arc2_7_4. visited = 0; 
arc2_7_4.next = &arc2_7_5; 
arc2_7_5.Node = &node2_8; 
arc2_7_5.visited = 0; 
arc2_7_5.next = NULL; 
node2_8.cell = &poly2_10; 
node2_8.arcList = &arc2_8_1 ; 
node2_8.predecessor = NULL; 
node2_8.curArc = NULL; 
node2_8.next = &node2_9; 
arc2_8_1 .Node = &node2_7; 
arc2_8_1. visited = 0; 
arc2_8_1.next = &arc2_8_2; 
arc2_8_2.Node = &node2_1 1; 
arc2_8_2.visited = 0; 
arc2_8_2.next = &arc2_8_3; 
arc2_8_3.Node = &node2_13; 
arc2_8_3. visited = 0; 
arc2_8_3.next = NULL; 
node2_9.cell = &poly2_8; 
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node2_9.arcList = &arc2_9_1 ; 
node2_9.predecessor = NULL; 
node2_9.curArc = NULL; 
node2_9.next = &node2_10; 
arc2_9_1.Node = &node2_7; 
arc2_9_1 .visited = 0; 
arc2_9_1.next = &arc2_9_2; 
arc2_9_2.Node = &node2_14; 
arc2_9_2. visited = 0; 
arc2_9_2.next = NULL; 
node2_10.cell = &poly2_9; 
node2_10.arcList = &arc2_10_1; 
node2_10.predecessor = NULL; 
node2_10.curArc = NULL; 
node2_10.next = &node2_1 1; 
arc2_10_1.Node = &node2_7; 
arc2_10_1 .visited = 0; 
arc2_10_1.next = &arc2_10_2; 
arc2_10_2.Node = &node2_15; 
arc2_10_2.visited = 0; 
arc2_10_2.next = NULL; 
node2_1 1 .cell = &poly2_1 1 ; 
node2_1 1 .arcList = &arc2_1 1_1 ; 
node2_1 1 .predecessor = NULL; 
node2_1 l.curArc = NULL; 
node2_1 1 .next = &node2_12; 
arc2_1 1_1 .Node = &node2_8; 
arc2_1 1_1. visited = 0; 
arc2_1 1_1 .next = &arc2_1 1_2; 
arc2_11_2.Node = &node2_12; 
arc2_1 1_2.visited = 0; 
arc2_11_2.next = NULL; 
node2_12.cell = &poly2_15; 
aode2_12.arcList = &arc2_12_1; 
node2_12.predecessor = NULL; 
node2_1 2.curArc = NULL; 
node2_12.next = &node2_13; 
arc2_1 2_1 .Node = &node2_1 1 ; 
arc2_12_1 .visited = 0; 
arc2_12_1 .next = &arc2_12_2; 
arc2_12_2.Node = &node2_16; 
arc2_12_2. visited = 0; 
arc2_12_2.next = NULL; 
node2_13.cell = &poly2_12; 
node2_13.arcList = &arc2_13_1; 
node2_1 3.predecessor = NULL; 
node2_1 3.curArc = NULL; 
node2_13.next = &node2_14; 
arc2_13_1.Node = &node2_8; 
arc2_13_1 .visited = 0; 
arc2_1 3_1 .next = &arc2_1 3_2; 



arc2_1 3_2.Node = &node2_17; 
arc2_13_2.visited = 0; 
arc2_1 3_2.next = NULL; 
node2_14.cell = &poly2_13; 
node2_14.arcList = &arc2_14_1; 
node2_14.predecessor= NULL; 
node2_14.curArc = NULL; 
node2_14.next = dnode2_15; 
arc2_1 4_1 .Node = &node2_9; 
arc2_14_1. visited = 0; 
arc2_14_1.next = NULL; 
node2_15.cell = &poly2_14; 
node2_15.arcList = &arc2_15_1; 
node2_15.predecessor = NULL; 
node2_15.curArc = NULL; 
node2_1 S.next = &node2_16; 
arc2_1 5_1 .Node = &node2_10; 
arc2_1 5_1 .visited = 0; 
arc2_15_1.next = NULL; 
node2_16.cell = &poly2_16; 
node2_16.arcList = &arc2_16_1; 
node2_16.predecessor= NULL; 
node2_16.curArc = NULL; 
node2_1 S.next = &node2_17; 
arc2_16_1.Node = &node2_12; 
arc2_16_1 .visited = 0; 
arc2_16_1.next = NULL; 
node2_17.cell = &poly2_17; 
node2_17.arcList = &arc2_l7_l; 
node2_17.predecessor = NULL; 
node2_17.curArc = NULL; 
node2_17.next = NULL; 
arc2_17_1.Node = &node2_13; 
arc2_1 7_1 .visited = 0; 
arc2_17_1.next = NULL; 



G. HOMOTOPY CLASSES 
1. cells.h 

r 

FILE: cells.h 

PURPOSE: This file contains the prototypes for the functions 
which are used to determine the homotopy classes 
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#ifndef cells_h 

#define cells_h 
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#include “build. h' 





This function determines whether the input point is inside of the 
convex polygon. It can be used to verify a suspected location, or 
called for every cell until a match is found. 



*********************************************************** *********«**^ 

int insideCell(polygon*, point): 



r findCell(worfd*, point*)**** 

This function calls insideCell() for every cell in the world until 
true is returned. It then returns a pointer to that cell 



polygon* findCell(world*, point); 
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/******findHmtpClss(node*, world*, point, point)******************' 
This function finds all the homotopy class from one point to the 
other by searching the connectity graph. 



void findHmtpClss(node*, world*, point, point); 
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/*..... .....dpthFstSch(nodg., node*, node*)******** 

This function performs a depth first search, and prints out the 
path found. The function is called recursively. 



/ 

void dpthFstSch(node*, polygon*, polygon*); 

#endif 



2. cells.c 



/* 

FILE: cells.c 

PURPOSE: This file contains the functions which are used to 
determine the homotopy classes 
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#include <stdlib.h> 

#include <stdio.h> 

#include “build.h" 

#include “util.h" 

static numberOfClasses; 

/* * **insideCell(polygon* point) ****' 

This function determines whether the input point is inside of the 
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convex polygon. It can be used to verify a suspected location, or 
called for every cell until a match is found. 



/ 

int 

insideCell(polygon* cnvxCell, point robotLocation){ 
vertex* curVertex; 
curVertex = cnvxCell->vertexList; 
dofrcheck all the vertices*/ 

if(order(robotLocation,curVertex->posit,curVertex->next->posit) < 0.0) 
curVertex = curVertex->next; 
else 

return 0;rmade a left turn*/ 

)vi/hile(curVertex != cnvxCell->vertexList): 

return 1 ;/*all right turns; inside cell*/ 

} 

/***************findCell{world*. point*)******************************* 

This function calls insideCellQ for every cell in the world until 
true is returned. It then returns a pointer to that cell 



/ 

polygon* 

findCell(world* decompWorld, point robotLocation){ 
polygon* curPolygon; 
curPolygon = decompWorld->polygonList; 
do{/*check all cells*/ 

if (insideCell(curPolygon, robotLocation)) 
return curPolygon; 
else 

curPolygon = curPolygon->next; 

}while(curPolygon != decompWorid->polygonList); 

return NULL;/*point is outside of world*/ 

} 

r dpthFstSch(node*, node*, node*) * 

This function performs a depth first search, and prints out the 
path found. The function is called recursively. 



* ****/ 

void 

dpthFstSch(node* cGraph, node* robNode, node* goalNode){ 

node* curNode; 
node* printNode = NULL; 
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extern int numberOfClasses; 



if(robNode == goalNode){/* we are at the goal 7 
printf(“The cell movement sequence for homotopy class number %d is\n", 
++numberOfClasses): 

r this block of code just prints out the path from the 
start node to the goal node 7 
curNode = goalNode; 
while(curNode->predecessor != curNode) 
curNode = curNode->predecessor; 
printf(“%s”,curNode->cell->name); 
while(curNode != goalNode){ 
printNode = goalNode; 
while(printNode->predecessor 1= curNode) 
printNode = printNode*>predecessor; 
printf(“->%s”,printNode->cell->name); 
curNode = printNode; 

printf(“\n”); 



}else{ 

while (robNode->curArc){/* for all nodes adj to this one 7 

if(!(robNode->curArc->Node->predecessor)){rhas not been checked 7 

robNode->curArc->Node->predecessor = robNode; 

dpthFstSch(cGraph, robNode->curArc->Node, goalNode); 

/* these are reset to allow for backtracking 7 
robNode->curArc->Node->curArc = robNode->curArc->Node->arcList; 
robNode->curArc->Node->predecessor = NULL; 

} 

robNode->curArc = robNode->curArc->next; 

} 

} 

) 

r findHmtpClss(node*, world*, point, point)***************************** 

This function finds all the homotopy class from one point to the 
other by searching the connectity graph. 



******************* ****** * / 

void 

findHmtpClss(node* cGraph, world* robWorld, point robLoc, point goalLoc){ 

polygon* robCell; 
polygon* goalCell; 

node* curNode; 
node* robNode; 
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node* goalNode; 



robCell = findCell(robWorld, robLoc); 
goalCell = findCell(robWorid, goalLoc); 
numberOfClasses = 0; 

r initialize graph */ 
curNode = cGraph; 
while(curNode){ 

curNode->predecessor = NULL; 
curNode->curArc = curNode->arcList; 
curNode = curNode->next; 

} 

if(robCell == goalCell) 
printffrobot and goal are in the same cell”); 
else{ 

/*find appropriate node on graph for robot’s location’/ 
robNode = cGraph; 
while(robNode->cell != robCell) 
robNode = robNode->next; 
robNode->predecessor = robNode; 

/’find appropriate node on graph for goal’s location’/ 
goalNode = cGraph; 
while(goalNode->cell != goalCell) 
goalNode = goalNode->next; 

dpthFstSch(cGraph, robNode, goalNode); 

} 

} 
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APPENDIX B 



This appendix is a users guide for the decomposition programs implemented as part 
of this thesis. It assumes that the user has a working knowledge of Yamabico’s kernel. 

A. CREATING VERTEX FILE 

The vertex file must be of the following form: 

world_name(polygon_name_1(mode(xii,yii)(xi2.yi2)-(xin.yin)) 

(polygon_name_2(mode(x2i,y2i)(x22.y22)-(x2m.y2m)) 

(polygon_name_k(mode(Xki.yki)(Xk2,yk2)-(Xki.yki))) 

where: 

world_name is a string of 15 or less characters. 
polygon_name_i is a string of 5 or iess characters, 
mode is 1 for normal holes, and -1 for inverted holes. 

(^ii-yi2)(^i2-yi2) "(^in-yin) an ordered list of vertices 
white space is ignored. 

B. RUNNING DECOMPOSE PROGRAM 

The command line for the DecomposeWorld program is: 

DecomposeWorld <inputfile> [number of sweeps] [sweep angie list] 

where: 

<inputfile> is the name of the file containing the world vertices and is of the form described 
in the first paragraph. This entry is mandatory. 

[number of sweeps] is the number of distinct decompositions desired for this world. This 
default value is 1. 

[sweep angie list] is a list of sweep angles. The number of entries in this list must match the 
number of sweeps desired. Each entry must be in the range (0.0.. 180.0]. Entries must be 
separated by whitespace. The default value is 90.0. 
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If only one sweep is performed, or the default values are used, then the program 
creates a file named plot.dat which contains the cell vertices in a format that can be used 
by GnuPlot. 

C. DECOMPOSED WORLD MODELS 

Each decomposition performed by DecomposeWorld creates a C file that is tagged 
with the sweep angle. Each file contains the declarations for the robot’s world and the 
connectivity graph associated with the decomposition. Additionally, each C file contains 
two functions which initialize these declarations when needed. In order to use these data 
structures, the following steps must be performed: 

1 . Compile and link each decomposeworld_xxx_xx.c file as a part of building the kernel. 

2. Include an extern declaration for the robot’s world and the connectivity graph 
for each representation. They should look like this; 

extern world robotsWorld_xxx_xx; 

extern node* worldGraph_xxx_xx; 

3. Before using the world information, call the following functions for each representation; 

I nitializeWorld_xxx_xx() ; 
lnitializeGraph_xxx_xx(); 
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